A 205  970 


m, 

. 


AF  T/GST/ENS/89M-6 


AN  I NVESTIGATION  INTO  THE  APPLICATION 
OF  DYNAMIC  PROGRAMMING  TO  DETERMINE 
OPTIMAL  CONTROLS  FOR  TRACKING 
A  CRUISE  MISSILE  MANUEVER  BY  CMMCA 
THESIS 

Leonard  G.  Heavner 
Carr.ain,  USAF 

A  F I T  /  G  S  T  /  E  N  S  /  8  9  M  -  6 


Approved  for  public  release;  distribution  unlisted 


APIT/GST/ENS/89M-6 


AN  INVESTIGATION  INTO  THE  APPLICATION 
OF  DYNAMIC  PROGRAMMING  TO  DETERMINE 
OPTIMAL  CONTROLS  FOR  TRACKING 
A  CRUISE  MISSILE  MANUEVER  BY  CMMCA 

THESIS 


Presented  to  the  Faculty  of  the  School  of  Engineering 
of  the  Air  Force  Institute  of  Technology 
Air  University 

in  Partial  Fulfillment  of  the 
Requirements  for  the  Degree  of 
Master  of  Science  in  Operations  Research 


Leonard  G.  Heavner,  B.S, 
Captain,  USAF 

March  1989 


Approved  for  public  release;  distribution  unlimited 


v*V 


deface 


The  study  was  meant  to  be  a  preliminary  investigation 
into  the  application  of  dynamic  programming  to  determine  the 
optimal  controls  to  track  a  cruise  missile  by  the  Cruise 
Missile  Mission  Control  Aircraft  ;CW MCA}.  As  such,  many 
questions  are  raised  by  this  study  about  the  application  of 
the  methodology  to  this  type  of  tracking  problem. 

The  concept  of  a  penalty  function  to  maintain  the 
cruise  missile  in  a  desired  position  within  the  radar  sweep 
cone  is  introduced.  This  penalty  function  is  by  no  means  the 
only  possible  performance  criterion.  Indeed,  further 
researcn  is  recommended  into  the  true  desires  of  a  CMMCA  crew 
they  track  a  cruise  missile’s  flight.  Improved  definitions 
of  the  penalty  function  are  suggested  by  this  investigation. 
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Abstract 


H  IS 


This  study  -invest igated  the  application  of  dynamic 
programming  to  determine  the  optimal  control  inputs  for 
tracking  a  cruise  missile  manuever  by  the  Cruise  Missile 
Mission  Control  Aircraft  (CMMCA).  Conventional  dynamic  pro¬ 
gramming  and  state  increment  dynamic  programming  were 
considered.  The  objective  was  to  minimize  cruise  missile 
deviations  from  a  desired  position  within  the  radar  sweep 
cone.  Only  single  turning  manuevers  of  the  cruise  missile 
were  investigated  in  this  study.  Implementation  on  a 
personal  computer  was  attempted.  Since  time  defined  the 


stages  for  the  dynamic  programming  method 


the  ^ffect  of 


different  time  increments  was  evaluated. 

The  study  found  state  increment  dynamic  programming 
difficult  to  implement.  Problems  were  encountered  in  the 
processing  of  block  boundaries.  Memory  limitations  of  the 

x 

FORTRAN  compiler  pr  oh  i  b  i  ted  't-be'  implement  at  ion  of  the  dynamic 
programming  technique  on  the  personal  computer.  The  methodo¬ 
logy  was  successfully  implemented  on  a  VAX  running  on  the  VMS 
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The  model,  as  formulated,  was  found  to  be  extremely 
sensitive  to  the  sise  of  the  time  increments  defining  the 
BtageB.  Widely  different  controls  were  computed  using  three 
different  time  increment'.  A  0.5  minute  time  increment  was 
determined  to  provide  the  best  results  of  the  increments 


invest 


igated.  ^  ■'  £  Cft'-n .  Tktts/tJcJ 


further  research  is  recommended  to  better  define  the 


penalcy  function  postulated  for  the  CMMCA  tracking  problem. 
Additional  investigation  is  also  suggested  into  the  appli¬ 
cability  of  state  increment  dynamic  programming  to  reduce 
high-speed  memory  requirements  and  possibly  allow  implemen¬ 


tation  on  a  personal  computer. 
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AN  INVESTIGATION  INTO  THE  APPLICATION 
OF  DYNAMIC  PROGRAMMING  TO  DETERMINE 
OPTIMAL  CONTROLS  FOR  TRACKING 
A  CROISE  MISSILE  MANUEVER  BY  CMMCA 


I.  Introduction 


The  mission  of  the  Cruise  Missile  Mission  Control 
Aircraft  (CMMCA)  is  to  track  cruise  missile  te3t  flights  and 
to  provide  airspace  surveillance  for  collision  avoidance. 
Tracking  the  cruise  missile  during  off-range  test  flights  is 
a  relatively  simple  process  since  the  cruise  missile’s  flight 
path  is  basically  straight  with  some  wide,  sweeping  turns. 
On-range  test  flights,  however,  present  a  more  challenging 
scenario.  The  cruise  missile  must  make  a  large  number  of 
turns  to  remain  within  the  limits  of  the  test  range.  At  the 
same  time,  CMMCA  attempts  to  maintain  the  maneuvering  cruise 
missile  within  its  radar  sweep  cone.  Because  of  the  dif¬ 
ferences  in  the  flight  characteristics  between  CMMCA  and  a 
cruise  missile,  tracking  the  missile  is  a  demanding  task  for 
a  CMMCA  aircrew. 

A  new  radar  is  being  placed  onboard  the  CMMCA  to  improve 
CMMCA ' s  ability  to  keep  the  airspace  around  the  missile 
clear  of  conflicting  traffic.  Unfortunately,  the  new  radar 
will  have^  a  relatively  narrow  field  ot  view,  both  in  range 


and  in  azimuth.  Though  not  absolutely  necessary,  it  is 
desirable  to  keep  the  cruise  missile  within  the  radar  sweep 
cone  during  missile  test  flights.  This  desire  has  raised 
questions  concerning  how  to  best  track  the  missile  and  keep 
it  in  the  radar’s  cone. 

Problem 

The  problem  addressed  by  this  thesis  was  to  determine 
the  optimal  control  inputs  a  CHMCA  crew  should  perform  in 
order  to  track  a  cruise  missile  as  it  manuevers  during  a  test 
flight  manuever. 

Scope 

The  scope  fcr  this  research  effort  was  limited  to  a 
single  cruise  missile  turn.  combination  turns  were  not 
considered.  The  controls  modeled  in  this  investigation  were 
bank  and  thrust. 

This  effort  also  considered  the  effect  of  changes  in 
the  size  of  the  time  increment  used  to  define  the  stages  of 
dynamic  programming.  The  sensitivity  of  the  solution 
technique  with  a  postulated  penalty  function  was  explored. 

Background 

Three  basic  techniques  were  considered  to  investigate 
this  problem.  Simulation  was  the  first  technique  that  seemed 
appropriate  for  the  question  at  hand.  Simulation,  unfor¬ 
tunately,  cannot  necessarily  provide  optimal  solutions. 
Dynamic  programming  was  next  considered.  The  large  number  of 
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variables  involved  in  this  tracking  problem  required  a  large 
amount  of  high-speed  memory  for  this  technique.  Another 
technique  considered,  state  increment  dynamic  programming, 
appeared  to  provide  a  methodology  to  handle  the  large  scope 
of  the  problem  a z  initially  stated. 

Assumptions  and  Limitations 

The  following  assumptions  will  be  made  in  the  solution 
of  the  CMMCA  tracking  problem! 

1.  The  model  will  work  in  three-dimensions.  However, 
both  the  CMMCA  and  the  cruise  missile  maintain  a 
constant  altitude  during  test  flights.  All  turns 
performed  by  both  vehicles  will  be  level  turns  in 
this  model. 

2.  The  model  will  use  nominal  values  for  aircraft 
capabilities  and  characteristics.  As  a  mission  is 
flown,  an  aircraft's  weight  decreases  which  in  turn 
affects  the  aircraft's  performance.  Por  simpli¬ 
fication,  the  performance  of  CMMCA  is  assumed 
constant  througout  a  manuever. 

3.  It  is  assumed  that  a  cost  or  penalty  function 
exists  for  allowing  the  cruise  missile  to  deviate 
from  the  desired  position  inside  the  radar  sweep 
cone  during  a  test  flight.  This  research  effort 
postulated  one  possible  formulation  of  this  penalty 

<  ii  ■>  m  k  I  «  «  rff  U.  m  a  «  •«  3  4  <  »  ^  f  /n  i»  ill  *  ►  ^  in  a  ,  m  ^ 
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meant  to  minimize  cruise  missile  deviations  from  a 
desired  position  within  the  radar  sweep  cone. 

4.  The  model  assumed  a  no-wind  condition. 

Overview 

Chapter  2  presents  background  on  possible  solution 
techniques  that  appeared  promising  in  the  solution  of  the 
problem  statement.  Simulation,  conventional  dynamic  pro¬ 
gramming,  and  state  increment  dynamic  programming  were 
considered . 

Chapter  3  discusses  the  methodology  of  dynamic  pro¬ 
gramming.  Since  conventional  and  state  increment  dynamic 
programming  share  common  characteristics,  both  are  presented 
in  detail. 

The  results  of  applying  dynamic  programming  to  this 
tracking  problem  are  presented  in  Chapter  4.  The  dif¬ 
ficulties  encountered  with  the  state  increment  methodology 
are  discussed  as  well  as  the  more  promising  results  obtained 
with  the  conventional  dynamic  programming  technique. 

Last,  Chapter  5  discusses  some  conclusions  and  recommen¬ 
dations  for  future  applications  of  dynamic  programming  to 
this  problem. 
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II.  Background 


Three  possible  approaches  were  considered  to  solve  the 
CMMCA  tracking  problem.  Simulation,  dynamic  programming, 
and  state  increment  dynamic  programming  were  considered  as 
alternative  techniques. 

Simulation 

One  method  to  attack  the  cruise  missile  tracking 
problem  is  to  employ  a  continuous  simulation.  Schuppe  has 
developed  a  continuous  simulation  model  that  attempts  to 
define  how  well  a  OMMCA  could  track  the  cruise  missile 
(10:1).  The  problem  is  workable  as  a  simulation  since  the 
modeling  of  the  movement  of  two  vehicles  ic  easily  accom¬ 
plished  using  the  equations  of  motion.  On  the  other  hand, 
the  development  of  a  guidance  algorithm  that  mathematically 
describes  how  an  aircraft  follows  a  missile  through  a 
manuever  is  a  more  difficult  problem. 

Schuppe's  simulation  did  not  attempt  to  identify  an 
optimal  guidance  algorithm  (10:1).  Instead,  he  attempted  to 
emulate  what  a  CMMCA  navigator  might  command  as  he  viewed 
the  progress  of  the  missile  on  his  radar  screen  (10:2). 
Bank  angle  and  airspeed  changes  for  the  CHMCA  were  based  on 
deviations  from  a  desired  position  behind  the  missile.  The 
simulation  used  maximum  roll  rates  and  accelerations  regard¬ 
less  of  the  size  of  the  deviation. 
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Schuppe  identified  a  requirement  for  an 
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improved  guidance  algorithm  (10:10).  His  simulacions 
demonstrated  that  simply  responding  to  deviations  in  arimuth 
and  range  appears  to  be  inadequate .  Schuppe  suggests  the 
need  for  a  guidance  algorithm  which  could  predict  future 
missile  positions  and  allow  CHMCA  to  respond  before  the 
missile  alters  its  flight  path  (10:10).  Nevertheless,  he 
believed  the  simulation  model  can  be  used  as  a  baseline  to 
measure  future  improvements. 

Dynamic  Programming 

A  methodology  that  is  often  well  suited  for  control 
problems  is  dynamic  programming.  This  methodology  can 
incorporate  the  future  knowledge  of  the  cruise  missile 
position  into  its  solution  technique.  Since  the  flight  paths 
of  the  cruise  missile  are  planned  out  in  advance  of  the  test 
flight,  future  positions  of  the  cruise  missile  are  known  in 
advance.  Armed  with  this  future  knowledge,  dynamic  program¬ 
ming  can  make  guidance  decisions  before  the  missile's  flight 
path  changes. 

Problems  or  processes  for  which  dynamic  programming  can 
be  applied  share  the  following  characteristics: 

1.  A  physical  system  characterized  at  any  time  by  a 
small  set  of  parameters,  i.e.  state  variables; 

2.  At  any  time,  there  exists  a  choice  of  a  number  of 
decisions,  i.e.  control  variables; 
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i.  The  effect  of  a  decision  is  a  transformation  of  the 
state  variables; 

4.  The  past  history  of  the  system  is  of  no  importance 
in  determining  future  actions; 

5,  The  purpose  cf  the  process  is  to  maximize  or 
minimize  some  function  of  the  state  variables 
(1:81-32) . 

The  CMMCA  tracking  problem  follows  the  characteristics 
of  a  dynamic  programming  problem.  There  exists  a  set  of 
parameters  that  define  the  system  at  any  time.  These 
parameters  would  be  analogous  to  the  parameters  used  in  a 
simulation  of  the  problem.  Generally  stated,  the  position 
and  velocity  of  the  CMMCA  are  useful  parameters  that  define 
the  state  of  the  system.  Position  tells  where  the  CMMCA  is 
currently  located  while  velocity  tells  where  it  is  going. 
Together,  the  two  parameters  completely  desc'ribe  the  CMMCA's 
s  t  a  _  e  . 

At  any  time,  a  choice  of  bank  angles  and  thrusts  are 
available  to  the  crew  of  the  CMMCA.  The  choices  made 
directly  impact  the  position  and  velocity  of  the  aircraft. 
The  question  of  how  the  CMMCA  arrived  at  its  current  position 
and  velocity  behind  the  missile  is  of  no  importance  to  the 
future  controls  applied  to  keep  the  missile  in  the  radar 
sweep  cone.  The  only  question  is  how  to  manuever  so  as  to 
proceed  in  an  optimal  way  from  the  current  state. 
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Lastly,  the  purpose  of  the  tracking  process  can  be 
defined  to  minimize  the  deviations  of  the  cruise  missile 
from  some  desired  position  within  the  radar  sweep  cone.  A 
penalty  function  that  minimizes  the  deviations  from  a 
desired  position  does  not  explicitly  exist  for  this  tracking 
problem.  Many  possible  forms  for  the  function  might  exist 
and  each  form  may  have  a  different  overall  effect  on  the 
results  of  a  dynamic  programming  solution.  Assuming  a 
penalty  function  can  be  postulated  which  accomplishes  the 
desired  minimization,  the  tracking  problem  follows  the 
characteristics  of  a  dynamic  programming  problem. 

All  the  variables  in  the  CMMCA  tracking  problems  are 
continuous.  The  position  and  velocity  of  CMMCA  as  well  as 
any  control  applied  will  be  defined  within  a  finite  rang**, 
but  may  take  on  an  infinite  number  of  values  with  this 
range.  Time  is  also  a  continuous  variable.  In  order  to 
apply  the  dynamic  programming  computational  procedure,  there 
must  be  a  finite  number  of  admissible  states  and  controls. 

This  requirement  can  be  met  by  quantizing  the  variables. 
Within  each  variable's  allowable  range,  each  is  quantized 
with  a  uniform  increment.  Time  is  also  quantized  to  pro/ide 
discrete  stages  at  which  each  control  is  tested.  The 
computational  procedure  can  then  be  applied  at  these  quan¬ 
tized  values  of  stage,  state,  and  control  variables.  A 
more  in-depth  discussion  of  the  computational  procedure  will 


be  given  in  Chapter  3. 


Bellman  and  Dreyfus  demonstrate  this  quantization  of 
continuous  variables  to  solve  an  aircraft  time  to  climb 
problem  (2:209-218).  The  state  variables  in  their  problem 
were  defined  to  be  altitude  and  velocity.  These  were 
quantized  into  1000  ft  increments  for  altitude  and  0.02  Mach 
increments  for  velocity.  The  only  control  variable  chosen 
was  the  climb  angle  of  the  aircraft.  They  assumed  maximum 
thrust  throughout  the  climb.  The  climb  angle  was  quantized 
to  be  either  zero  for  a  level  acceleration  or  the  angle 
necessary  for  a  constant  velocity  climb.  The  objective 
function  was  to  minimize  the  time  necessary  to  climb  to  a 
predetermined  altitude  and  velocity. 

Through  the  application  of  the  dynamic  programming 
methodology,  they  were  able  to  predict  the  minimum  time-to- 
climb  to  a  desired  altitude  and  velocity.  The  technique 
also  suggested  the  required  climb  profile  required  to 
achieve  the  minimum  time.  The  profile  produced  proved  to  be 
more  complicated  than  a  human  pilot  might  be  able  to  follow. 
Consequently,  they  believed  the  most  useful  purpose  of  the 
solution  may  well  be  to  serve  as  a  guide  and  criterion  to 
establishing  practical  minimum-time  paths  (2:218). 

One  of  the  difficulties  encountered  when  applying 
dynamic  programming,  especially  to  a  continuous  problem,  is 
'curse  of  dimensionality'  (1:9)  This  curse  arises  out  of  the 
need  to  maintain  at  least  two  storage  locations  for  each 
quantized  state  of  the  system:  one  tor  the  value  of  the 


objective  funt  ;on  and  jne  for  the  optimal  control.  The 
number  of  locations  required  is  then 

n 

Nh  *  2  IT  N.  (2.1) 

i  “1 

where  N ^  is  the  number  c  f  quantized  values  of  the  ith 
variable  and  n  is  the  number  of  state  variables  (7:34). 
Thus,  if  there  are  3  state  variables  and  100  quantization 
levels  in  each  variable,  then  the  required  number  of  memory 
locations  is  2,000,000.  A  high  dimension  problem  with  just 
a  few  quantized  values  could  saturate  a  computer  system. 

State  Increment  Dynamic  Programming 

Larsen  conceived  state  increment  dynamic  programming 
as  an  optimization  procedure  that  has  all  the  desirable 
properties  of  the  conventional  dynamic  programming  computa¬ 
tional  procedure,  but  requires  much  less  high-speed  memory 
(7:39).  He  accomplishes  this  reduction  by  introducing  two 
additional  concepts:  the  block  and  the  time  over  which  a 

control  is  applied. 

The  concept  of  the  block  is  the  primary  vehicle  by 
which  Larson  accomplishes  the  reduction  in  required  high¬ 
speed  memory.  Blocks  are  defined  by  partitioning  the  (n+1)- 
dimensional  space  containing  the  n  state  variables  plus  time 
into  rectangular  sub-units  (7:46).  Each  block  contains  a 
small  nuBDer  of  each  quantized  state  and  quantised  Lime, 
Quantized  states  along  the  boundary  of  a  block  are  considered 
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to  belong  to  all  blocks  that  snare  that  boundary.  This 
sharing  allows  for  some  transition  capabilities  between 
blocks. 

Each  block  is  processed  individually.  When  all  compu¬ 
tations  are  completed  in  a  block,  that  block  is  snapped  out 
of  high-speed  memory  into  bulk  memory,  and  a  new  block  iz 
processed.  Overall,  high-speed  memory  requirements  can  then 
be  controlled  by  selectively  choosing  the  number  of  quantized 
states  contained  within  the  block.  The  successful  processing 
of  the  blocks  depends  on  the  next  concept. 

A  fundamental  difference  between  state  increment 
dynamic  programming  and  conventional  dynamic  programming  is 
the  method  for  determining  the  time  interval  over  which  a 
given  control  is  applied  (7;43).  In  conventional  dynamic 
programming,  the  next  state  is  always  taken  to  occur  in  one 
time  increment  after  the  present  state.  Thus,  each  control 
is  applied  for  a  fixed  amount  of  time  and  there  is  no 
guarantee  that  the  next  state  will  be  near  the  present  state. 
State  increment  dynamic  programming,  however,  determines  the 
minimum  time  interval  required  for  any  one  of  the  state 
variables  to  change  by  one  increment.  Each  control  might 
then  be  applied  for  different  lengths  of  time,  but  in  no 
case  will  a  state  variable  be  allowed  to  change  by  more  than 
one  increment.  This  requirement  ensures  the  next  state  lies 
near  the  current  state. 
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It  is  this  difference  that  enables  state  increment 
dynamic  programming  to  reduce  the  high-speed  memory  require¬ 
ments  from  those  of  conventional  dynamic  programming  (7:46). 
If  the  next  state  is  close  to  the  present  state,  roost  of  the 
computations  can  be  kept  within  the  block.  Only  those 
states  that  lie  along  the  boundaries  of  a  block  will  require 
special  computational  effort.  Controls  applied  at  these 
boundaries  might  transition  into  the  adjacent  blocks  which 
may  not  reside  in  high-speed  memory.  Larson  proposes 
several  techniques  to  handle  such  occurrences  (7:80).  These 
techniques  will  be  discussed  in  Chapter  3. 

Larson  demonstrates  an  application  of  state  increment 
dynamic  programming  in  a  minimum-fuel  trajectory  problem  for 
a  supersonic  transport  (6:135-140).  This  problem  is  similar 
to  the  t ime-to-climb  problem  described  earlier.  State 
variables  are  again  altitude  and  velocity  with  the  same 
increments  of  1000  ft  and  0.02  Mach  respectively.  The  set  of 
admissible  controls  for  this  problem  were  defined  as  follows: 
climb  at  constant  velocity,  dive  at  constant  velocity, 
accelerate  at  constant  altitude,  decelerate  at  constant 
altitude,  and  cruise  at  constant  altitude  and  velocity. 
Thrust  and  climb  angles  for  each  of  these  admissible  controls 
were  then  defined.  The  objective  function  was  to  minimize 
the  fuel  used  during  the  hypothetical  flight. 

Larson  defined  the  blocks  for  the  state  increment 
technique  to  contain  three  quantised  values  for  each  of  the 
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state  variables  plus  three  quantized  values  of  time.  The 
requirement  for  high-speed  memory  was  only  54  storage 
locations:  one  location  for  the  value  of  the  objective 
function  and  one  location  for  the  optimal  control  at  each  of 
the  27  quantized  states  in  the  block.  The  minimum-fuel 
profile  was  generated  for  a  1000  mile  flight  in  approximately 
1  hour  of  computing  time  on  an  IBM  ?090  (6:142). 

Conclusion 

The  tracking  of  a  cruise  missile  during  a  test  flight 
appears  to  require  future  knowledge  of  the  missile's  position 
for  CMMCK  to  adequately  track  it.  This  requirement  suggested 
a  technique  with  the  characteristics  of  dynamic  programming 
to  estimate  a  flight  profile  that  minimizes  the  deviations 
from  a  desired  position.  Due  to  the  high  dimensionality  of 
the  problem,  however,  some  method  to  reduce  high-speed 
memory  requirements  would  be  helpful.  State  increment 
dynamic  programming  provides  the  technique  which  reduces 
this  memory  requirement.  This  research  effort  explored  the 
use  of  both  conventional  and  state  increment  dynamic  pro¬ 
gramming  . 
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III.  Methodology 

The  optimization  problems  to  which  dynamic  programming 
have  been  applied  are  variously  called  dynamic  optimization 
problems,  variational  control  problems,  or  optimization 
problems  for  multistage  decision  processes  (7:12/ .  Whatever 
the  name,  three  essential  elements  exist  for  both  conven¬ 
tional  and  state  increment  dynamic  programming  problems; 
the  system  equations,  the  performance  criterion,  and  the  con¬ 
straints.  Once  these  elements  were  defined,  a  problem 
statement  was  made,  and  the  solution  process  initiated. 
While  the  overall  process  for  state  increment  dynamic 
programming  was  essentially  the  same  as  the  conventional 
technique,  some  minor  modifications  were  made  to  employ  the 
state  increment  methodology.  A  method  to  evaluate  the 
performance  of  the  solution  for  the  three  time  increments 
was  also  defined.  Additionally,  since  the  cruise  missile's 
position  was  required  at  each  time  stage  for  the  evaluation 
of  the  penalty  function,  a  simulation  of  the  cruise  missile's 
flight  was  written. 

System  Equations 

The  system  equations  define  the  relationships  between 
three  sets  of  variables:  the  stage  variable,  the  state 

variable,  and  the  control  or  decision  variable. 

Stage  Variable.  The  stage  variable  determines  the 


order  that  events  occur  within  the  system.  This  variable  can 


be  either  continuous  or  discrete.  If  it  is  continuous,  3uch 
as  time,  it  can  be  denoted  as  c  and  iB  usually  defined  over 
an  interval  tQ  <**  t  <*  t^.  On  the  other  hand,  if  it  is 
discrete  it  can  be  defined  as  the  sequence  k  ■*  0,1,. ..,K. 
When  the  stage  variable  is  continuous,  it  is  quanti2ed  into 
increments,  perhapr  denoted  as  dt  when  time  is  involved.  The 
quantized  values  of  t  that  lie  in  the  range  for  which  t  is 
defined  can  be  indexed  by  the  discrete  sequence  k  *  0,1,..., K 
where  the  value  of  t  corresponding  to  k  is  given  by 


tQ  +  k  dt 


3.i: 


and  where 


K  dt  -  tf  -  t  (7:12)  . 


(3.2) 


This  method  of  quantizing  time  into  discrete  elements 
was  employed  for  the  solution  of  the  CMMCA  tracking  problem. 
To  explore  the  effect  of  the  time  increment  size  on  the 
solution  process,  three  time  increments  were  used  in  this 
research  effort:  0.3  minute,  0.5  minute,  and  0.7  minute. 
The  number  of  time  intervals,  or  stages,  in  each  solution 
proc:  or  dependent  upon  the  missile’s  length  of  flight. 

State  Variables.  The  state  variables  are  a  set  of 
variables  that  completely  describe  the  system.  They  describe 
the  pystem  in  the  sense  that  if  their  values  are  known  for 
all  k,  k  «  0,1,2,. ..,K,  then  any  question  about  the  behavior 
c c  system  for  this  range  of  k  can  be  answered  (7:i2) 
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The  choice  of  a  set  of  state,  variables  for  a  particular 
systea  is  not  unique.  Determination  of  a  suitable  set  <e  de¬ 
pendent  on  the  nature  of  the  mathematical  model  of  the 
systea.  If  n  non-tedundant  state  variables  can  be  specified, 
they  can  be  denoted  x^ ,x2,- . . .  ,xn  and  are  often  written  as  an 
n-dimensional  vector,  X,  called  the  state  vector. 

For  the  CMMCA  tracking  problem,  the  state  vector 
consisted  of  four  elements.  The  first  two  elements  were  the 
x  and  y  position  of  CMMCA  on  the  Cartesian  reference  frame 
wit-h  the  x-axis  aligned  with  east  and  the  y-axis  aligned  with 
nortn.  One  unit  along  either  axis  will  represent  1  nautical 
mile.  The  third  element  used  was  the  CMMCA's  heading,  h, 
in  radians  and  defined  as  the  angle  between  the  y-axis  and 
CMMCA ' s  velocity  vector  in  a  clockwise  direction.  The  last 
element  in  the  state  vector  chosen  was  the  CMMCA' s  true  air¬ 
speed,  v,  in  nautical  miles  per  minute.  Thus,  the  state 
vector  was  written: 

x  ( t ) 

X(t)  -  (3.31 

V  (  t ) 

In  order  to  apply  a  dynamic  programming  solution 
technique,  the  state  variables  must  also  be  quantized  as 
discussed  earlier.  For  this  problem,  the  increments  for  each 
state  variable  were 
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dx(t)  ■  2  nautical  Biles 
dy{t)  *  2  nautical  miles 
dh{t)  »  45  degrees 

dv(t)  -  0.583  nautical  itiiles/min.  (3.4) 

The  choice  of  these  increments  was  based  on  a  desire  to  keep 
the  number  of  quantized  states  at  a  manageable  level.  For 
this  initial  investigation  into  the  application  of  dynamic 
programming  to  the  tracking  problem,  the  size  of  these 
increments  were  judged  to  provide  adequate  coverage  of  tha 
state  space. 

Control  Variables.  The  control  variables  are  those 
variables  in  the  process  that  can  be  modified  or  controlled. 
These  variables  influence  the  process  by  affecting  the  state 
variables  in  some  prescribed  fashion.  There  are,  in  general, 
q  control  variables  denoted  ,u2, . . . ,Uq.  These  variables 
are  generally  arranged  in  a  q-dimensional  vector,  D,  called 
the  control  vector.  The  control  variables  used  for  CMMCA 
were  bank  angle,  b,  and  thrust,  p.  The  control  vector 
was  written: 


0(t) 


b(t) 
p(  t ) 


(3.5) 


For  this  investigation,  thrust  was  not  defined  as  an  appli¬ 
cation  of  force.  Rather,  it  was  thought  of  as  a  ratio  of 
the  maximum  acceleration,  or  deceleration,  available  to  the 
CMMCA  crew.  For  example,  a  thrust  of  1.0  was  considered  the 
thrust  required  for  a  maximum  aCCeletauiOu  1  Pi  altcpecd  while 


-1.0  represented  a  maximum  deceleration.  Maximum  accel- 
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eration  and  v>axi mum  deceleration  not  necessarily  equal 
for  the  CMMCA  in  flight.  However,  thi3  research  assumed  the 
maximum  acceleration  and  dece) eratior.  were  equal. 

It  war  assumed  that  bank  angles  and  thrust  applications 
were  attained  instantaneously.  As  the  time  increment  used 
to  define  the  stages  of  dynamic  programming  is  made  smaller, 
the  assumption  will  make  the  solution  less  valid.  Since  the 
minimum  time  increment  was  0.3  minute  (18  seconds)  and 
maximum  bank  angles  and  thrust  can  be  attained  in  a  few 
seconds,  this  assumption  should  have  little  effect  on  the 
problem . 

The  set  of  admissible  controls  chosen  for  this  problem 
were:  constant  heading  and  speed,  turn  right  at  constant 
speed,  turn  left  at  constant  speed,  accelerate  on  a  constant 
heading,  and  decelerate  on  a  constant  heading. 

System  Equations.  The  system  equations  describe  how  the 
state  variables  of  stage  k  +  1  are  related  to  the  state 
variables  at  stage  k  and  the  control  variables  at  stage  k. 
If  the  stage  variable  is  time,  the  system  equation  may  be 
written 

X ( t  +  dt )  «X(t)+flX(t),U(t)rt]dt  (3.6) 

where  f  is  an  n-dimensional  vector  function  (4:250). 

Given  the  above  state  and  control  vectors  for  the  CMMCA 
tracking  problem,  the  vector  function  becomes 


> 


» 


§ 


* 


flXU),U(t),ti  - 


v{t)sin[h(c)]  +  gtan[b(t ) ]cos[h(t) ]t 
v(t)cos(h(t)  j  -  gtan[b{t ) jsinlh(t) jt 
gtan[b(t) ]  /  v(t) 
constant 


(3.7) 


The  derivation  of  these  system  equations  is  provided  in 
Appendix  A. 

Performance  Criterion 

The  performance  criterion  evaluates  a  particular  control 
policy.  This  criterion  can  be  either  a  reward  function  to  be 
maximized  or  a  cost  function  to  be  minimized.  Tha  perfor¬ 
mance  criterion  depends  on  the  value  of  U(t)  in  the  control 
sequence,  and  also  on  each  value  of  the  state  vector,  X(t). 
If  the  criterion  is  denoted  as  J,  it  can  be  written 


J  * 


(  L[X(t),U(t)  ,t]  dt  +  0[X(t. 

J  f 


tf  ] 


(3.8) 


where  l  and  0  are  scalar  functions  representing  cost  per  unit 
time  and  terminal  cost,  respectively  (4:250).  The  remainder 
of  this  discussion  assumes  the  performance  criterion  is  a 
penalty  function  to  be  minimized. 

The  performance  criterion  does  not  explicitly  exist  for 
the  CMMCA  tracking  problem.  The  approach  used  for  this 
research  effort  was  to  minimize  the  time-weighted  deviations 
from  a  desired  location  ahead  of  the  CMMCA .  There  are  two 
types  of  deviations  horn  a  desired  position  within  the  radar 
sweep  cone .  Tne  first  deviation  is  pure  range,  R,  measured 
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in  nautical  miles.  The  second  is  azimuth,  A,  measured  in 
radians.  To  achieve  similar  units  for  these  two  deviations, 
azimuth  deviations  were  converted  to  miles  by  treating  the 
deviation  as  an  arc  segment  with  length  ( RxA ) .  Thus,  the 

objective  function  was  to  minimize  the  time-weighted  mileage 

* 

from  an  optimal  range,  R  .  This  function  was  written  as 

L [ X ( t ) ,U(t) ,t]  =  1 R* -R  !  +  | R* A | .  (3.9) 

Absolute  values  were  taken  to  ensure  that  only  positive 
mileage  deviations  were  obtained.  This  same  function  will 
also  be  used  as  the  terminal  penalty  function. 

Constraints 

The  constraints  place  restrictions  on  the  values  that 
the  state  variables  and  control  variables  can  assume. 
For  this  research  effort,  arbitrary  constraints  were  placed 
on  the  range  of  the  x  ( t )  and  y(t)  variables.  The  range  of 
the  heading  variable  is  defined  by  the  degrees  in  a  circle. 
Constraints  that  define  the  performance  of  CMMCA  come  from  an 
interview  with  Horton  (3)  and  from  operational  experience. 
The  constraints  were  stated  as  follows: 


0 

<* 

x  ( t ) 

<« 

150 

(nautical  miles) 

0 

<  ■ 

y(t) 

<- 

150 

(nautical  miles) 

0 

<  “ 

h(t) 

O 

360 

( degrees ) 

5.5 

<  ® 

v  ( t ) 

<- 

7.83 

(nm  per  min) 

-30 

<* 

b  ( t ) 

<- 

30 

( degrees ) 

-1 

<  = 

p  ( t ) 

o 

1 

(%  of  min/max) 

problem  statement 

The  optimization  problem  can  new  be  stated  as; 

Given 

1.  A  system  described  by  equation  3.6  and  3.7 

2.  Constraints  as  stated  by  equation  3.10,  and 

3.  An  initial  state 
Find : 

The  control  sequence  u  ( tQ )  ,u ( t ^ ) , . . . ,u  ( tf )  such  that  J 
in  equation  3.6  is  minimized  while  satisfying  the  con¬ 
straints. 

Solution  Process 

Bellman's  Principal  of  Optimality.  The  heart  of  dynamic 
programming  is  Bellman's  principle  of  optimality.  This 
principle  states: 

An  optimal  policy  has  the  property  that  whatever 
the  initial  state  and  initial  decision  are,  the 
remaining  decisions  must  constitute  an  optimal 
policy  with  re]ard  to  the  state  resulting  from  the 
first  decision  (1:83). 

In  other  words,  the  minimum  cost  for  state  X  at  stage  t  is 
found  by  choosing  the  control  that  minimizes  the  sum  of  the 
cost  function  to  be  paid  at  the  present  stage  and  the  minimum 
cost  in  going  to  the  end  from  the  state  at  time  t+dt  which 
results  from  applying  this  control.  By  applying  this 
principle,  the  control  sequence  that  minimizes  J  is  obtained. 

Computational  Process.  Computationally,  the  solution 
technique  begins  at  the  final  stage,  The  terminal 

penalty  is  computed  for  each  quantized  state.  These  penal- 


t-ias  represent  the  penalties  incurred  by  the  CMMCA  if  it 
were  to  arrive  at  these  quantized  states  at  the  end  of  the 
oanuever . 

After  all  the  terminal  penalties  are  computed,  the 
preceding  stage  (i.e.  next  to  last  stage)  is  processed. 
Again,  at  each  quantized  state,  the  penalty  is  computed  for 
arriving  at  that  state  at  this  stage.  Each  control  is  then 
applied.  Any  control  that  results  in  a  violation  of  a 
constraint  is  not  allowed.  For  example,  the  deceleration 
control  is  not  allowed  if  the  current  state  is  already 
at  the  minimum  allowable  velocity. 

The  next  state  after  applying  a  control  for  one  time 
increment  will  likely  not  be  a  quantized  state.  The  penalty 
for  arriving  at  this  non-quant i zed  state  is  interpolated 
from  adjacent  quantized  states.  The  sum  of  the  current 
penalty  and  the  value  of  the  penalty  for  the  next  state  is 
then  the  penalty  incurred  by  applying  the  control.  Thus,  the 
optimal  control  is  the  one  with  the  least  total  penalty. 

After  all  the  optimal  controls  hved  been  computed  for 
each  quantized  state,  the  optimal  controls  for  the  current 
stage  are  saved  in  low-speed  memory.  The  next  stag0  is 
then  processed  in  the  same  manner.  These  computations  t>re 
repeated  until  the  first  stage,  representing  t  ,  is  pro¬ 
cessed  . 

The  final  step  in  the  solution  process  is  to  establish 
the  control  sequence  that  minimizes  the  penalty  function. 
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First,  the  set  of  optimal  controls  for  the  stage  at  t  is 
retrieved.  If  the  initial  state  of  the  system  is  a  quan¬ 
tized  state,  the  optimal  control  is  found  directly  by  the 
optimal  control  for  that  state.  If  the  initial  state 
is  not  a  quantized  value,  an  interpolation  is  performed 
from  adjacent  quantized  states  to  determine  the  optimal 
control.  The  control  is  applied  and  the  next  state  deter¬ 
mined.  This  process  was  repeated  until  the  final  stage 
is  reached. 

For  the  CMMCA  tracking  problem,  linear  interpositions 
were  used  for  both  the  interpolation  of  penalties  and 
controls.  First,  this  interpolation  procedure  was  the 
simplest  to  implement.  The  increments  used  were  considireo 
small  enough  to  allow  the  use  of  a  linear  interpolation 
without  large  errors.  And  since  the  exact  nature  of  the 
penalties  and  optimal  controls  at  the  quantized  states  is 
unknown,  a  linear  interpolation  seems  advisable  as  a  first- 
cut  approximation  for  this  initial  investigation. 

State  Increment  Modifications 

The  size  of  the  blocks  used  in  the  state  increment 
technique  must  be  defined.  For  the  CMMCA  tracking  problem, 
the  block  size?  were  defined  to  contain  five  quantized  states 
of  x ( t )  and  y(t),  five  quantized  states  of  h(t),  three  quan¬ 
tized  states  oc  v(t),  and  eight  quantized  states  increments 
of  time.  High  speed  memory  requirements  for  each  block  was 
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then  3000  locations  for  each  evaluation  of  the  penalty 
function  and  3000  for  each  optimal  control . 

Unlike  conventional  dynamic  programming ,  the  time  a 
control  was  applied  was  only  as  long  as  it  took  for  one 
state  variable  co  change  by  one  increment.  The  next  state 
that  resulted  after  applying  the  control  for  the  prescribed 
amount  of  time  will  also  net  likely  be  a  discrete  state. 
Interpolation  was  used  to  compete  the  penalty  of  the  next 
non-quantized  state. 

As  mentioned  in  the  previous  chapter,  a  strategy  was 
needed  for  controls  that  result  in  a  transition  to  a  block 
not  yet  computed.  The  simplest  technique  Larson  suggested  is 
to  exclude  all  controls  wh^ch  result  in  such  a  transition 
during  the  computation  of  a  block  (7:80).  He  suggested  tne 
transition  be  considered  only  after  both  blocks  have  been 
computed . 

Larson  also  suggested  that  a  more  accurate  procedure  for 
processing  these  transitions  would  be  to  extrapolate  the 
minimum  penalty  function  to  the  not-yet-computed  block 
(7:83).  He  suggested  this  extrapolation  be  accomplished  by 
fitting  a  low-order  polynomial  in  the  state  variables  to 
values  of  the  minimum  penalty  at  quantized  states  on  or  near 
the  boundary. 

For  this  effort,  the  first  method  was  chosen  to  tran¬ 
sition  between  blocks.  The  primary  reason  for  this  choice 
was  the  ease  of  application. 


Wsaring  the  Performance  of  the  Three  Time  Increments 

Some  criteria  is  required  to  measure  the  effect  of  the 
different  time  increments  on  the  dynamic  programming  solution 
is  required.  Three  criteria  were  chosen  for  this  investi¬ 
gation  . 

1.  Would  a  CMMCA  crew  judge  the  controls  as  appropriate 
for  tracking  the  cruise  missile.  This  criteria 
would  be  a  judgement  decision. 

2.  The  profile  generated  should  minimize  the  average 
time-weighted  deviations  from  a  desired  position. 
This  criteria  would  be  an  evaluation  of  how  well  the 
pen  function  performed  using  the  dynamic 
programming  methodology.  Since  the  number  of  stages 
for  each  time  increment  is  dependent  upon  the  flight 
time  of  the  missile,  an  average  over  time  cf  these 
deviations  was  used  as  a  performance  measure. 

3.  The  profile  should  minimize  the  maximum  deviations 
from  the  desired  position  was  used.  For  two  time 
increments  with  average  deviations  approximately 
equal,  this  investigation  looked  at  the  minimum 
range  and  maximum  azimuth  that  resulted  if  the 
controls  generated  were  followed. 

Cruise  Missile  Position 

In  order  to  evaluate  a  penalty  at  the  quantized  states, 
the  cruise  missile's  position  must  be  known  at  the  discrete 
times  which  detine  the  stages  in  the  solution  technique.  A 
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•mall  simulation  of  a  missile's  flight  was  written  using 
the  equations  of  motion.  The  cruise  missile's  position  was 
required  every  0.3,  0.5,  or  0.7  minutes  to  correspond  ’.ith 
the  stages  defined  in  the  above  formulation.  The  missile's 
position  was  recorded  every  0.1  minutes,  however,  in  order  to 
validate  the  performance  of  the  optimal  controls  derived  from 
the  application  of  this  technique. 

Implementation 

This  investigation  into  the  CHMCA.  tracking  problem 
was  an  exploration  of  the  possibilities  of  dynamic  pro¬ 
gramming.  While  the  solution  technique  can  be  implemented 
on  a  main  frame  computer,  a  personal  computer  was  also 
considered  as  a  possibility  for  the  implementation  of  this 
solution  technique.  The  personal  computer  would  enable  quick 
evaluations  of  the  controls  that  might  be  required  to  follow 
the  missile.  Since  a  FORTRAN  compiler  is  readily  available 
for  personal  computers,  it  was  chosen  is  the  language  for 
this  application. 

Conclusion 

The  system  equations,  performance  criterion,  and 
constraints  were  established  for  the  CMMCA  tracking  problem. 
Within  this  framework,  the  dynamic  programming  problem 
statement  was  then  made.  The  solution  technique  of  conven¬ 
tional  dynamic  programming  was  next  explored.  Though  the 
solution  technique  of  state  increment  is  similar  to  conven- 


tional,  two  modifications  were  required.  A  method  of 
evaluating  the  sensitivity  of  dynamic  programming  to  the 
size  of  the  time  increment  was  defined.  A  description  of 
how  the  cruise  missile  position  i?  known  at  any  time  was 
presented  along  with  an  overview  of  the  implementation 
strategy  planned. 
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IV.  Results 


I 


% 


A  dynamic  programming  model  was  successfully  implemented 
to  determine  the  optimal  controls  required  to  track  a  missile 
by  CMMCA.  Though  it  was  chosen  to  provide  a  means  to  control 
the  high-speed  memory  required  of  dynamic  programming,  state 
increment  dynamic  programming  proved  to  be  difficult  to 
implement.  The  state  space  as  presented  in  Chapter  3  was 
reduced  to  keep  the  size  of  the  problem  ivithin  the  high-speed 
memory  capabilities  of  a  personal  computer.  The  FORTRAN 
compiler  for  the  personal  computer,  unfortunately,  did  not 
allow  enough  computational  capacity  for  even  the  reduced 
state  space.  A  successful  application  of  dynamic  programming 
was  accomplished  on  a  VAX  mainframe.  An  evaluation  of  the 
different  time  increment  size  was  made  from  the  mainframe 
runs.  Four  common  characteristics  present  themselves  after 
using  dynamic  programming  for  tracking  missile  turns. 

State  Increment  Dynamic  Programming 

State  increment  dynamic  programming  was  chosen  as  a 
solution  technique  to  control  the  high-speed  memory  require¬ 
ments  of  dynamic  programming.  Problems  were  encountered  with 
the  technique  mainly  because  of  the  high  dimensionality  of 
the  problem  as  formulated. 

The  first  difficulty  encountered  with  state  increment 
oynamic  programming  was  the  process  of  interpolating  a  value 
for  the  penalty  function  when  the  next  state  was  not  a 
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quantized  state.  Tne  dimensionality  of  the  tracking  problem 
as  formulated  is  five — four  state  variables  plus  time. 
Since  a  control  is  ..pplied  until  at  most  one  state  variable 
ch/*r"  .8  by  one  increment,  interpolation  was  required  for  the 
remaining  three  s  :ate  variables  plus  time.  Performing  a 
linear  interpolation  in  four  dimensions  required  values  for 
the  penalty  function  at  16  quantized  points.  The  relative 
positions  of  the  required  16  points  to  one  another  within  the 
block  was  dependent  upon  the  current  state  and  the  control 
applied.  The  changing  relative  positions  made  the  inter¬ 
polation  process  difficult. 

The  most  difficult  problem  encountered,  however,  was 
processing  the  quantized  states  along  the  boundaries  of 
each  block.  The  method  of  excluding  controls  which  result  in 
transitions  into  adjacent  blocks  proved  to  be  unsatisfactory. 
The  accuracy  of  the  penalty  incurred  along  the  boundaries 
was  diminished  by  using  this  technique.  These  inaccuracies 
were  then  compounded  when  controls  were  applied  and  the  next 
state  was  close  to  the  block  boundaries.  The  boundary 
processing  technique  chosen  appears  to  be  limited. 

These  conclusions  were  arrived  at  from  some  initial 
applications  of  state  increment  dynamic  programming.  To 
track  a  missile  in  a  straight  flight  path,  the  optimal 
controls  that  were  produced  call  for  bank  and  thrust  appli¬ 
cations.  This  did  not  agree  with  expectations.  The  solution 
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should  have  showed  the  CHMCA  following  a  straight  flight  path 
behind  th«  missile. 

Return  to  Conventional  Dynastic  Programing 

with  the  failure  of  state  increment  dynamic  programming 
as  formulated,  an  attempt  to  reduce  the  high-speed  memory 
requirements  was  made  by  reducing  the  site  of  the  state 
space.  This  reduction  was  primarily  necessitated  by  the  high 
dimensionality  of  the  CMHCA  tracking  problem.  To  reduce 

the  memory  requirement,  the  x-y  grid  was  reduced  signifi¬ 
cantly.  The  increment  size  remained  at  two  miles  for  each 
dimension  but  the  constraints  for  allowable  x(t)  and  y(t) 
values  were  redefined  to  describe  a  smaller  state  space. 
Those  constraints  were  rewritten  as 

C  <«  x(t)  <*  28  (nautical  miles)  .. 

0  <«  y ( t )  <-  28  (nautical  miles).  '  *  ' 

All  other  constraints  remained  the  same. 

Still,  at  any  discrete  time  stage,  a  rather  large 
high-speed  memory  requirement  exists.  There  are  15  discrete 
values  of  x  and  y,  eight  discrete  values  of  heading,  and  five 
discrete  values  of  airspeed  in  this  reduced  problem. 
Thus,  9000  discrete  states  exist  at  every  discrete  time 
stage.  For  every  discrete  state,  a  memory  location  must  be 
allocated  for  the  penalty  at  the  last  stage  processed,  the 
penalty  at  the  current  stage,  and  the  optimal  control  applied 
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at  the  current  stage.  The  high-speed  memory  requirement 
increased  to  27,000  memory  locations. 

FORTRAN  further  requires  four  bytes  of  memory  to  store 
the  data  for  one  memory  location.  To  implement  dynamic 
programming  and  solve  the  reduced  tracking  problem  would 
thus  require  108,000  bytes  of  memory.  While  personal 
computers  with  sufficient  high-speed  memory  are  available, 
the  FORTRAN  compiler  used  only  allowed  65,536  bytes  of  memory 
for  variables  and  constants  (9:53).  Even  this  reduced 
problem  became  too  big  to  be  implemented  on  the  personal 
computer . 

Implementation  on  the  VAX 

The  FORTRAN  code  was  next  loaded  onto  a  VAX  running 
under  the  VMS  operating  system.  The  dynamic  programming 
technique  was  successfully  executed  with  the  increased 
processing  power  provided  by  the  VAX.  The  source  listing  of 
the  code  is  provided  in  Appendix  B. 

The  program  is  menu  driven.  The  first  step  is  to  enter 
a  cruise  missile  manuever  .  The  missile's  speed,  starting 
coordinates,  begin  turn  coordinates,  bank  angle  in  the  turn, 
end  stopping  coordinates  are  required  during  this  step.  From 
this  ini  .''■mation,  a  simulation  is  executed  of  the  flight  of 
the  missile.  Its  position  is  recorded  every  0.1  minutes. 

The  next  step  is  to  initiate  the  dynamic  programming 
portion  nf  the  program,  Once  initiated,  the  program  computes 
tne  optimal  control  at  each  quantized  state  and  saves  the 
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result  in  low-speed  memory.  Control  is  returned  to  the  main 
menu  after  all  stages  have  been  completed. 

The  user  can  now  retrieve  the  optimal  controls  for  any 
initial  state  of  the  CMMCA.  The  initial  position,  heading, 
and  airspeed  behind  the  missile  can  be  specified.  If  the 
initial  state  is  not  a  discrete  state,  the  program  will 
interpolate  the  initial  controls  required  for  this  initial 
state.  The  flight  of  CMMCA  is  then  simulated.  The  results 
of  this  simulated  flight  are  printed  to  the  screen  as  well  as 
to  the  file  ' RESULTS . DAT  '  The  results  for  three  turns  of  a 
cruise  missile  at  each  of  the  three  time  increments  under 
investigation  are  given  in  Appendix  C. 

Evaluation  of  Different  Time  Increment  Sizes 

The  dynamic  programming  model  as  formulated  proved  to 
be  extremely  sensitive  to  the  size  of  the  time  increment  used 
to  define  the  stages.  A  90,  180,  and  270  degree  turn  was 
executed  for  each  of  the  time  increments. 

The  0.3  minute  time  increment  was  expected  to  produce 
better  results  over  the  other  two  time  increments.  This  was 
not  the  case  ir.  any  of  the  turns.  By  the  first  criteria,  it 
would  be  unlikely  that  a  CMMCA  crew  would  follow  the  controls 
from  any  of  the  turns.  The  90  degree  turn  produced  a  bank 
to  the  right  followed  by  a  bank  to  the  left  ending  on 
another  right  bank.  Both  the  180  and  2  70  degree  turns 
resulted  in  the  optimal  controls  driving  the  CMMCA  into  a 
position  almost  directly  over  the  missile.  These  results 
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would  nc-r  be  considered  as  appropriate  by  the  crew.  On  the 
first  criteria  alone,  the  results  of  the  0.3  minute  incre¬ 
ments  were  unsatisfactory .  This  result  is  likely  due  to  the 
proposed  formulation  of  the  penalty  function  used  in  this 
investigation . 

The  0.5  minute  and  0.7  minute  increments  both  provided 
more  realistic  results  when  compared  against  the  first 
criteria.  The  second  criteria  of  average  deviations  from 
the  desired  position  proved  to  be  a  less  conclusive  measure¬ 
ment  than  hoped.  The  following  table  summarizes  the  results. 

Table  I.  Average  Time  Weighted  Deviations  in  Miles 

0.5  Minute  0.7  Minute 

90  Degree  Turn  4,53  5,29 
180  Degree  Turn  7.94  7.94 
270  Degree  Turn  9.12  8.87 

No  clear  best  choice  could  be  made  based  on  this  criteria. 

The  last  criteria  provided  the  deciding  factor.  The 
maximum  deviations  observed  from  the  desired  location  were 
less  with  a  time  increment  of  0.5  minute  than  the  0.7  minute 
increment.  For  example,  in  the  270  degree  turn,  the  0.5 
minute  interval  produced  a  minimum  range  of  4.92  and  a 
maximum  azimuth  of  110  degrees.  The  0.7  minute  interval,  on 
the  other  hand,  yielded  a  minimum  range  of  4.03  and  a  maximum 
azimuth  of  180  degrees.  By  these  criteria,  the  0.5  minute 
time  interval  is  the  best  time  interval  for  the  CMMCA 


tracking  problem  of  those  tested. 


Common  Characteristics  of  Turns 


From  the  turns  executed  by  this  investigation,  four 
characteristics  of  the  dynamic  programming  solution  become 
apparent.  First,  when  the-  CMMCA  is  matching  the  cruise 
missile  speed  prior  to  the  missile's  turn,  the  optimal 
control  to  apply  prior  to  the  turn  of  the  missile  is  a 
deceleration.  All  three  of  the  sample  tnanuevers  have  this 
control  as  the  initial  response.  This  result  appears  to  be 
caused  by  the  closure  that  occurs  as  the  missile  begins  its 
turn . 

Second,  both  bank  and  thrust  controls  are  called  for 
simultaneously  in  the  dynamic  programming  solution.  The  set 
of  allowable  controls,  however,  used  to  produce  these  results 
did  not  include  simultaneous  application  of  bank  and  thruBt. 
For  example,  the  set  of  controls  considered  at  each  quantized 
state  allowed  either  a  bank  or  a  thrust  change,  or  neither, 
but  not  both  at  the  same  time.  This  innnnnnnn  nresult  is 
realistic  of  how  a  CMMCA  aircrew  would  actually  track  a 
cruise  missile. 

Third,  small  control  inputs  may  present  themselves  as 
the  optimal  control  at  any  stage.  Bank  angles  of  two  or 
three  degrees  cannot  be  accurately  maintained  by  a  human 
pilot.  These  small  control  inputs  may  be  caused  by  the 
interpolation  process  in  the  retrieval  of  optimal  controls. 
These  small  controls,  though  suggested  as  optimal  by  this 


methodology,  will  not  be  practical  during  actual  test 
flights . 

Finally,  as  the  CMMCA  starts  to  fall  in  behind  the 
mi  S3 i le  after  the  completion  its  turn,  small  oscillations 
occur.  A  small  right  bank  may  be  called  for  at  one  stage 
followed  by  a  small  left  bank  in  the  next.  Oscillations  may 
be  caused  by  the  ?ize  of  the  increments  used  to  quantize  the 
state  variables.  The  increments  chosen  for  this  solution  are 
relatively  large.  A  finer  resolution  might  reduce  these 
oscillations . 

Conclusions 

While  it  is  a  technique  designed  to  control  high-speed 
memory  requirements,  state  increment  dynamic  programming 
requires  accurate  transitions  across  the  boundaries  to  be 
successfully  implemented.  Conventional  dynamic  programming's 
large  requirement  for  high-speed  memory  is  the  limitation 
for  successful  implementation  on  a  personal  computer  using 
FORTRAN.  The  methodology  as  formulated  and  implemented  on  a 
mainframe  is  also  highly  sensitive  to  the  size  of  the  time 
increment  used  to  define  the  stages.  For  the  0.5  minute 
time  increment,  insight  is  gained  into  the  optimal  controls 
from  the  characteristics  observed  from  the  cruise  missile 


turns  demonstrated. 


V.  Conclusion  and  Recommendations 


Conclusions 

Tracking  of  a  cruise  missile  by  CMMCA  has  proven  to  be 
an  extremely  complex  problem.  The  initial  ambitious  goal  of 
implementing  dynamic  programming  on  a  personal  computer  was 
not  successful  even  with  the  state  increment  dynamic  pro¬ 
gramming  technique.  The  high  dimensionality  for  the  problem 
as  formulated  proved  to  be  one  of  the  greatest  obstacles  for 
this  solution  process. 

The  application  of  dynamic  programming  to  the  tracking 
problem  does  not  require  a  sophisticated  tracking  algorithm 
to  compute  optimal  controls.  It  does,  however,  require  some 
performance  criterion  by  which  to  measure  the  effect  of  the 
controls.  This  performance  criteria,  or  penalty  function, 
was  somewhat  hypothetical  in  this  solution  technique. 
As  stated  for  this  research  effort,  the  penalty  function 
attempted  to  minimize  missile  deviations  from  a  desired 
position.  It  is  conceivable  that  a  CMMCA  crew  may  have  come 
other  objective  while  tracking  a  missile.  They  may,  for 
example,  only  want  to  minimize  the  time  the  cruise  missile 
spends  outside  the  radar  sweep  cone.  The  penalty  function 
used  for  this  research  was  completely  subjective  and  other 
possible  formulations  exist. 

The  application  of  this  model  to  the  CMMCA  tracking 
problem  is  limited  in  scope.  As  formulated,  only  single 
turns  of  the  cruise  missile  can  be  simulated.  The  optimal 


controls  generated  are  a  complex  series  of  bank  and  thrust 
changes  h‘  a  CMHCA  aircrew  might  not  be  able  to  follow  pre¬ 
cisely.  Because  of  these  results,  the  model  should  only  be 
used  to  gain  insight  into  the  necessary  controls  that  might 
be  required  of  CMMCA  during  a  missile  turn. 

The  model  as  formulated  also  proved  to  be  extremely 
sensitive  to  the  size  of  the  time  increment  which  defines 
the  stages  in  the  dynamic  programming  model.  This  investi¬ 
gation  found  that  too  small  of  an  increment  led  to  controls 
an  CMMCA  would  not  judge  prudent  while  too  large  an  increment 
can  produce  greater  maximum  deviations  from  the  desired 
position.  This  result  is  likely  caused  by  the  form  of  the 
penalty  function  used  in  this  investigation. 

Recommendations 

On  the  surface,  dynamic  programming  is  an  excellent 
method  of  computing  the  controls  necessary  to  track  a  missile 
test  flight.  The  methodology  accounts  for  the  impact  of  the 
future  position  of  the  missile  on  control  inputs  at  any 
stage.  Three  areas  require  further  study  before  the  methodo¬ 
logy  can  be  applied  on  a  broader  scale. 

First,  another  investigation  into  the  oplicability  of 
state  increment  dynamic  programming  still  seems  promising. 
The  technique  reduces  the  high-speed  memory  requirements 
and  provides  a  method  which  allows  the  implementation 
of  dynamic  programming  on  a  personal  computer.  This  investi¬ 
gation  points  to  the  need  for  an  accurate  method  to  process 
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the  transitions  of  block  boundaries.  The  second  technique 
proposed  by  Larson  of  extrapolating  the  penalty  function 
into  the  not-yet-computed  block  may  prove  more  accurate. 

Another  area  for  further  investigation  would  be  into 
the  effect  a  linear  interpolation  has  on  the  performance  of 
the  model.  This  investigation  assumed  a  linear  interpolation 
as  a  first  cut.  Perhaps  a  quadratic  curve  fitting  technique 
or  some  other  technique  may  lead  to  more  accurate  results. 

Finally,  and  probably  most  importantly,  a  refinement  of 
the  penalty  function  for  trie  methodology  is  needed.  The 
penalty  function  used  in  this  effort  commands  controls  that 
keep  the  cruise  missile  near  a  desired  position.  It  is 
possible,  however,  that  this  is  not  the  true  objective  of  a 
CMMCA  aircrew.  Currently,  the  CrtMCA  aircrew  are  also  not 
certain  as  to  their  true  objective.  To  evaluate  the  per¬ 
formance  of  different  penalty  functions,  similar  criteria  to 
those  used  to  evaluate  the  increment  size  for  time  in  this 
investigation  might  be  appropriate.  Future  applications  cf 
this  methodology  should  investigate  better  definitions  for 
this  objective. 
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APPENDIX  A.  Equations  of  Motion 


Equations  of  motion  will  apply  to  both  the  CMMCA  and 
the  cruise  missile.  The  axis  of  the  reference  frame  for  the 
derivation  of  these  equations  will  have  the  x-axis  aligned 
with  east  and  the  y-axis  aligned  with  true  north.  Define 
heading,  h,  as  the  angle  between  the  ^-ax:s  and  the  velocity 
vector  measured  in  a  clockwise  direction.  The  rate  of 
change  for  the  x  position,  y  position,  heading,  and  velocity 
can  now  be  derived. 


X  and  Y  Position  Rate  of  Change 

When  an  aircraft  makes  a  level  turn,  the  velocity  vector 
will  change  over  time  because  of  centripetal  acceleration. 
The  magnitude  of  the  rate  of  change  can  be  written 


(A.l' 


It  can  be  shown  that  the  centripetal  acceleration  in  a  level 
turn  is  defined  as  follows: 


ac  a  g  tan(b) 


(A. 2) 


where  g  is  the  magnitude  of  the  acceleration  vector  due  to 
gravity  and  b  is  tne  aircraft's  bank  angle  (3:71).  Combining 
equations  A.l  and  A. 2  yields  the  relationship 


g  tan(b) 


(A. 3) 


1C4_. 


When  equation  A. 3  is  integrated,  with  a  speed  vQ  at  t*0  and  a 
constant  bank  angle,  the  following  relationship  results 


|  v  { t ) 


vQ  +  g  tan(b)  t 


(A. 4) 


defining  the  magnitude  of  aircraft's  velocity  as  a  function 
of  time. 

By  definition,  the  x-y  components  of  the  velocity 
vector  define  the  rate  of  change  of  the  aircraft's  x  and  y 
position.  To  decompose  equation  A. 4  into  its  x-y  components, 
it  can  be  thought  of  as  the  sum  of  two  vector  quantities. 

The  first  part,  v  ,  is  the  aircraft's  speed  at  time  0. 
When  the  aircraft  is  flying  a  heading  h  in  degrees,  the  x-y 
components  can  be  written 


Vv  *  V.  sin{h) ; 


Vy  -  vQ  cos { h ) . 


(A. 5) 
(A. 6) 


The  second  part,  g  tan(b)  t,  is  the  contribution  of  the 
centripetal  acceleration  to  the  velocity  vector.  Because  the 
centripetal  acceleration  acts  90  degrees  to  the  aircraft's 
heading,  the  x-y  components  can  be  written 


1  x  =  g  tan(b)  s  i  r.  ( h  +  90)  t ; 
Jy  *  g  tan(b)  cos(h  +  90)  t. 


(A. 7) 
(A. 8) 


Equations  A  7  and  A. 8  can  be  further  reduced  to  yield 


/  K  \  nne  /  K  \ 


-  -g  tan(b)  sin(h)  t 


(  A  .  9  ) 
A.  10) 
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The  direction  for  each  of  the  above  components  is 
determined  by  the  aircraft's  bank  angle  as  well  as  the 
heading.  By  de^i  ‘inn  a  left  bank  as  negative  and  a  right 
Lank  as  positive,  the  proper  direction  for  ef.ch  component 
v.'ili  ie  obtai.-.ed. 

Bti-'c-iiig  these  two  component  parts  together,  the 
function  defining  the  rate  o!  change  of  the  aircraft's  x  and 
y  position  can  be  written.  The  following  relationships  are 
obtained  by  combining  the  component  parts  described  above 
into  equation  A. 4: 

4jr  *  sin(h)  +  g  tan(b)  cos(h)  t  (A. 11) 

at  o 

and 

cos(h)  -  g  tan(b)  sin(h)  t.  (A. 12) 

Heading  Rate  of  Change 

In  a  level  turn,  the  rate  of  change  of  the  airframe's 
heading  is  governed  by  the  following  (4:425): 


dh  g  tan(b) 

It  "  \ T - 

o 


(A. 13) 


Velocity  Rate  of  Change 

For  straight  ahead  acceleration,  a  summation  of  the 
forces  acting  along  the  longitudinal  axis  of  the  airframe 
results  in  the  following  equation: 


dv  (T  -  D) 

Tt  E  - m - 


(  A  .  1  4  ) 


41 


where  T  is  the  aircraft's  thrust,  D  its  drag,  and  m  its  mass. 
Each  of  these  three  parameters  is  a  function  of  other 
aircraft  parameters.  Thrust  is  a  function  of  altitude  and 
fuel  flow.  Drag  is  a  function  of  weight,  velocity,  altitude, 
and  flight  path  angle.  Mass  is  a  function  of  the  fuel  flow. 

Thus,  the  velocity  rate  of  change  is  a  complex  rela¬ 
tionship  of  many  variables.  For  simplicity  and  the  short 
time  period  under  consideration,  this  research  effort  assumed 
nominal  values  of  thrust,  drag,  and  mass.  This  allowed 
accelerations  to  be  considered  constant. 


APPEND I X  B.  Source  Code 


The  source  code  for  the  FORTRAN  program  used  to  imple¬ 
ment  the  dynamic  program  used  to  determine  the  optimal 
controls  to  track  a  cruise  missile  turn  follows.  The  code 
was  compiled  and  executed  on  a  VAX  running  on  the  VMS 
operating  system. 


o  o  o  ooo  r>  o  o  o  r>  r> 
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****************** ft ft* ft******************************** ft*** *********** 

TITLE:  CMMCA  Dynamic  Program  to  Track  Cruise  Missile  Manuevera 

AUTHOR:  Capt  Leonard  C.  Heavier 

DATE:  12  Jan  89 

DESCRIPTION:  This  prograa  Implements  a  aynamic  program  algorithm 
to  track  a  cruise  missile  during  a  turning  manuever. 
The  algoritha  is  implemented  in  three  main  modules. 
The  first  plots  the  cruiae  missile’s  position  as  it 
makes  a  turn.  The  second  module  determines  the 
optimal  controls  to  track  the  nissile  at  each 
quantized  point  in  the  state  space.  The  lest  module 
determines  the  optimal  trajectory  for  a  given 
inital  state.  This  is  the  controlling  module.  It 
prompts  the  user  through  the  use  of  a  menu.  After 
the  user  makes  a  selection,  the  appropriate  module 
is  called. 

************************************** a******************************* 

PROGRAM  CMMCA 


INCLUDE  SYSVAR.COM/LIST* 
INTEGER  CHOICE 


> 

+ 


LOGICAL  DONE, 
VALID 


Initialize  the  prograa 

CALL  INTPRM 

DONE  -  .FALSE. 

VALID  -  .TRUE. 

Until  the  user  is  done,  clear  the  screen  and  get  request 

10  IF  (.NOT. DONE)  THEN 

CALL  CLS 

If  choice  is  not  v,.'lid,  print  error  message 

IF  (.NOT. VALID)  THEN 
PRINT  100,  CHOICE 

100  FORMAT ( 1X,T26,,",,I1,'"  IS  NOT  A  VALID  CHOICE’///) 

VALID  “  .TRUE. 

END  IP 

DispLay  menu  and  read  choice 
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non  non 


110 

+ 

+ 

+ 


PRINT  110 

POSMATC 1X,T25, ’CMMCA  FLIGHT  PLAN  GENERATOR’/// 

T20, ' 1  -  ENTER  CRUISE  MISSILE  FLIGHT  PATH'// 
T20, *2  -  COMPUTE  CMMCA  FLIGHT  PATH'// 

T20, *3  -  PRINT  CMMCA  FLIGHT  PATH'// 

T20, *4  -  QUIT'/// 

T28 , '  ENTER  CHOICE'/) 


READ  (*,*)  CHOICE 


Call  the  appropriate  subroutine  aodule  or  signal  when  done 

I?  ( CHOICE. EQ.l)  THEN 
CALL  CMFTPN 

ELSEIF  ( CHOICE. EO. 2)  THEN 
CALL  FLTPLN 

ELSEIF  (CHOICE. EQ. 3)  THEN 
CALL  FRNTFP 

ELSEIF  (CHOICE. EQ. 4)  THEN 
DONE  -  .TRUE. 

ELSE 

VALID  -  .FALSE. 

ENDIP 

GOTO  10 
ENDIF 

Clear  the  screen  before  quitting 

CALL  CLS 
END 
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i ********************6* ************************************************ 


C  * 

C  *  SUBROUTINE:  CMFTPN 

C  * 

C  *  DESCRIPTION:  Simulates  the  flight  of  a  cruise  missile  in  one 

C  *  turning  manuever  and  records  its  position  at 

C  *  predetermined  intervals. 

C  * 

C  *******•*.-,-*  ***************************************************  ********* 

SUBROUTINE  CMFTPN 

INCLUDE  'SYSVAR.COM' 

INCLUDE  'CMVAR.COM' 

INTEGER  NUMVP,  WAYPT ,  I 

C 

C  Open  the  file  to  store  the  missile's  position,  clear  the  screen, 

C  snd  initalire  the  variables 

r 

OPEN  (UNIT- 10, FILE* 'CMPOSTN.DAT' .ACCESS*' DIRECT' , 

+  STATUS-  NEW’ .FORM- 'UNFORMATTED ’ ,R£CL-8) 

CALL  CLS 
TNOW  -  0. 

ETA  -  0. 

ETE  -  0. 

TIMINC  -  .1 
G  -  19.32 
C 

C  Display  the  header  read  the  cruise  missile's  speed,  starting 
C  coordinates,  and  begin  turn  coordinates. 

C 

PRINT  100 

100  FORMAT  ( 1X,T25 , ' SUBROUTINE  CRUISE  MISSILE  FLIGHT  PATH'//// 

+  IX, 'ENTER  CRUISE  MISSILE  SPEED  (KNOTS)  -'/) 

£AD  (*,*)  SPEED 
?EED  -  SPEED/60.0 

.  ’INT  no 

110  FORMAT  (/IX, 'ENTER  THY  STARTING  COORDINATES  (X  AND  Y)  -'/) 

READ  (*,*)  XPOS.fPOS 
PRINT  120 

120  FORMAT  (/IX, 'ENTER  THE  BEGIN  TURN  COORDINATES  (X  AND  Y)  -’/) 

READ  (*,*)  NEXTX.NEXTY 
C 

C  Record  this  initial  position  and  determine  next  time  to  record 
C 

WRITE  (10.REC-1)  SNGL(XPOS) ,  SNGL(YPOS) 

TRECRD  -  TIMINC 


*-3  0  n  no 


Move  the  missile  to  the  begin  turn  coordinate*  in  a  linear  fashion 
CALL  LINEAR 

Get  the  bank  angle  in  the  turn  and  the  stopping  coordinates 
PRINT  130 

130  FORMAT  (/IX, ’ENTER  THE  BANK  ANGLE  (DEGREES)  -’ /) 

READ  (*,*)  BANK 
BANK  -  BANK/180. 0*PI 

PRINT  140 

140  FORMAT  (/IX, 'ENTER  THE  STOPPING  COORDINATES  (X  AND  Y)  -’/) 

READ  (*,*)  NEXTX ,NEXTY 
C 

C  Turn  the  missile.  When  headed  toward  the  stopping  coordinates, 

C  move  it  again  in  a  linear  fashion  until  done 

C 

CALL  TURN 
CALL  LINEAR 
C 

C  Determine  the  the  last  stage  for  the  dynamic  program.  The  last 
C  stage  will  be  a  whole  increment  of  time.  Close  the  file 

C  containing  the  cruise  missile’s  position. 

C 

TMAX  -  DTINE*IFIX(TNOV/DTIME) 

CLOSE  (10) 

RETURN 

END 


o  o  o  o  o  o  n 


LINEAR 


*******  <t******t ****************************** *t ******»**» ************** 
*  * 
* 

* 

* 

* 

* 

* 

£« 


SUBROUTINE: 


DESCRIPTION: 


Moves  the  cruise  missile  in  a  linear  fashion.  * 
At  the  appropriate  time,  the  missile' a  position  * 
is  recorded  at  the  appropriate  intervals.  * 

* 


SUBROUTINE  LINEAR 


INCLUDE  'SYSVAR.COM' 
INCLUDE  'CMVAR.COM' 


C 

c 
c 

C 
C 

I 


While  t.ie  missile  has  not  arrived  at  the  next  point,  move  the 
the  missile  forward  to  the  next  time  to  record  position, 
record  position,  and  compute  the  next  time  to  record 

10  I?  ( TRECRD. LE, ETA)  THEN 

XPOS  H  XPOS+XSPEED* ( TRECRD-TNOW ) 

YPOS  -  YPOS+YS  PEED* ( TRECRD-TNOW ) 

TNOW  -  TRECRD 

WRITE  ( 10 ,REC-IFIX(TRECRD*RECRAT/DTIME+1 ) ) 

+  SNGL(XPOS) ,SNGL(YP0S) 

TRECRD  -  TRECRD  +  TIMINC 
GOTO  10 
ENDIE 


DOUBLE  PRECISION  RANGE 

Determine  the  appropriate  range  and  heading  to  the  next  point. 

Also,  calculate  the  x  and  y  velocity  components  and  the  time 
of  arrival  at  this  next  point 

RAT'T  -  DSORT ( ( NETT* -XPOS ) **2+ (NEXTY-YPOS )  **2 ) 

H5ADNG  *  DATAN2  (NEXTX-XPOS , NEXT?- YPOS ) 

XSPEED  -  SPEED* DS IN (HEADNG) 

YSPEED  -  SPEED* DCOS(HEADNG) 

ETA  -  nOW  +  SNGL( RANGE /SPEED) 


Upon  arrival,  ensure  the  missile  is  at  the  desired  point 

C 

TNOW  -  ETA 
XPOS  -  NEXTX 
YPOS  -  NEXTY 

RETURN 

END 
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A********************************************************************** 


SUBROUTINE: 


DESCRIPTION: 


TURN 


* 
* 
* 

Simulates  the  flight  of  the  cruise  missile  in  * 
a  turn.  Continues  the  turn  until  the  missile's  * 
heading  will  take  it  to  the  next  point.  * 


*********************************************************************** 

SUBROUTINE  TURN 


INCLUDE  'SYSVAR.COM' 
INCLUDE  'CMVAR.COM' 


LOGICAL  INTURN 


DOUBLE  PRECISION  TRNRAT ,  STEPTM, 

+  XSTEP,  YSTEP , 

+  LASTBG,  BEARNG 

Initialire  variables,  determine  turn  rate,  and  detemine  the 
bearing  to  the  next  point 

INTURN  -  .TRUE. 

TRNRAT  -  G*TAN( BANK)/ SPEED 
LASTBG  -  DATAN2 (NEXTX-XPOS , NETTY- YPOS) 

C 

C  Make  the  correction  to  the  missile's  heading  baaed  on  direction  of 
C  turn  necessary  to  determine  when  the  missile  is  headed  at  the 

C  next  point. 

C 

IF  ( BANK.GT.O. AND. HEADNG. GT. LASTBG)  THEN 
HEADNG  -  HEADNG  -  2*DPI 
ELSEIF  ( BANK. LT.O. AND. HEADNG.LT. LASTBG)  THEN 
HEADNG  -  HEADNG  +  2*DPI 
END  IF 
C 

C  !lhile  the  missile  is  turning,  do 
C 


10  IF  (INTURN)  THEN 

C 

C  Determine  the  appropriate  time  increment  to  move  the  missile  in 
C  the  turn 

C 

IF  (TRECRD-TNOW.LT.TIMINC/10)  THEN 
STEPTM  -  TRECRD-TNOW 
ELSE 

STEPTM  "  TIMING/ 10 
END  IP 


o  r>  o  ononon  oooo 


Determine  the  next  heading,  x  and  y  position,  and  bearing  to  the 
next  point. 

HEADNG  -  HEADNG+TRNRAT*STEPTM 
XSTEP  «  XPOS+SPEED*DSIN(HEADNG)*STEPTM 
YSTEP  »  Y?0S+SPEED*DC0S(HEADNG)*3TEPTM 
BEARNG  -  DATAN2 ( NETTX-XSTEP , NFXTY-YSTEP ) 

This  logic  determines  when  the  missile  transitions  through  the 
third  and  fourth  quadrants  of  the  arctangent  function. 

If  a  transition  is  made,  the  missile’s  heading  is  adjusted 
so  that  the  missile  trill  stop  the  turn  at  an  appropriate  time. 

IF  ( DS IGN ( DPI , LASTBG ) . NE . DS IGN ( DP I , BEARNG ) . AND . 

+  DABS (BEARNG). GT. DPI /2)  THEN 

IF  ( LASTBG . GT . BEARNG . AND . HEADNG . GT . BEARNG )  THEN 
HEADNG  -  HEADNG  -  2*DPI 

ELSEIF  (LASTBG. LT.BEARNG.AND.HEADNG.lt. BEARNG)  THEN 
HEADNG  -  HEADNG  +  2*DPI 
END  IP 
ENDIF 

If  the  missile  has  turned  past  the  next  point,  stop  turn 

IF  ( BANK. GT.O.AND, HEADNG. GT. BEARNG)  THEN 
IWTURN  -  .FALSE. 

ELSEIF  ( BANK. LT.O. AND. HEADNG.lt. BEARNG)  THEN 
INTURN  -  .FALSE. 

ENDIF 

C 

C  If  the  turn  ia  not  completed,  update  the  missile's  position,  update 
C  the  time,  and  remember  the  current  bearing  to  the  next  point 

C 

IF  (INTURN)  THEN 
XPOS  “  XSTEP 
YPOS  -  YSTEP 
TNOW  -  TNOW  +  STEPTM 
LASTBG  -  BEARNG 
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If  it  is  tiae  for  a  recording,  record  the  position  and  update  the 
next  tiae  to  record. 


IF  (TNOW.EQ. TRECRD)  THEN 

WRITE  ( 10  ,REC"IPIX(TH_ECSD*RECRAT/DTIME+1 )  ) 
SHGL(XPOS),  SNGL(YPOS) 
TRECRD  -  TRECRD  +  TIMINC 
ENDIF 
ENDIF 
GOTO  10 
ENDIF 


RETURN 

END 
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C  *********************************************************************** 

C  *  * 


C  * 
c  * 
c  * 
c  * 
c  * 
c  * 
c  * 


SUBROUTINE: 

DESCRIPTION: 


FLTPLN 

This  subroutine  steps  through  each  quantized 
state  and  determine*  the  optimal  control  for 
each.  The  optimal  control*  for  all  stages  and 
the  final  penalty  at  each  quantized  state  are 
saved  in  files. 


C  « 

C  ********************************************************************** 


SUBROUTINE  FLTPLN 


INCLUDE  ’SYSVAR.COM' 

INCLUDE  ’DPVAR.COM’ 

INTEGER  T,  I,  SAVCON(9000) 

REAL  LPNOWC9000),  LPLAS(9000) 

C 

C  Three  1-Dimenslonal  arrays  are  equivalenced  to  the  arrays  holding 
C  the  penalties  and  optimal  controls.  These  arrays  facilitate 

C  the  manipulation  of  the  penalty  and  control  arrays. 

C 

EQUIVALENCE  (SAVCONU ) ,0PTCNT( 1 , 1 , 1 , 1 ) ) , 

+  (LPN0W(1),PEM*0V(1, 1,1,1)), 

+  (LPLaS(1),PENLAS(1, 1,1,1)) 

Open  the  file  containing  the  cruise  missile  position.  Also, 
establloh  the  files  to  contain  optimal  control  and  final 
penalties. 

OPEN  (UNIT- 10, FILE- ’CMP0STN.DAT’ .ACCESS- ’DIRECT’ , 

+  STATUS- ’OLD' , FORM- ’ UNFORMATTED ' .RECL-8) 

OPEN  (UNIT-11, FILE-’ PENALTY. DAT’ .ACCESS-’ SEQUENTIAL’ , 

+  STATUS- ’NEW’ ) 

OPEN  (UNIT-1 2, FILE- ’CONTROL. DAT’ .ACCESS- ’DIRECT ’ , 

+  STATUS- ’NEW’ .FORM- ’UNFORMATTED’ .RECL-6000) 

Clear  the  screen  and  display  the  header 

CALL  CLS 

PRINT  *, ’SUBROUTINE  COMPUTE  CMMCA  FLIGHT  PATH’ 

PRINT  * 

PRINT  * 

Initialize  the  dynamic  program  variables  and  display  the  last  time 
being  called  a  stage 

CALL  DfTDP 

PRINT  *, ’COMPUTING  PENALTY  AT  TMAX  -’ ,TMAX 

PRINT  * 
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i^r^cr- 


Read  the  missile  position  at  the  last  time  stage  and  display  on 
screen 

REAP  (lO,REC«IFrX(TMAXnaClAT/DTIME+l))  CMXPOS,  CMYPOS 
PRINT  *, ’CMXPOS  -* .CMXPOS,’  CMYPOS  -*, CMYPOS 

For  each  quantised  state,  determine  the  penalty  for  arriving 
at  that  state  In  the  last  stage 

DO  10  X-l.WY 

PRINT  *,’X  BLOCK  -’,X 
XPOS  -  XMIN+(X-1)*DX 
DO  20  Y-l.WY 

YPOS  '  YMIN+(Y-1)*DY 
DO  30  HDG-l.WHDG 

HDGPOS  -  HDGMIN+(KDG-1)*DHDG 
DO  40  VEL-1 ,WZL 

VELPOS  -  VELMDH  ( VEL- 1 )  *DVEI, 

PENUStt.Y.HDG.VZL)  - 

+  PENLTY(XPOS,YPOS,HDGPOS, 0.0, 0.0, CMXPOS, CMYPOS, DTIHE) 

40  CONTINUE 

30  CONTINUE 

20  CONTINUE 

10  CONTINUE 

For  each  of  the  remaining  stages,  display  the  time  for  the  stage, 
read  and  display  the  missile  position  at  that  tiae 

DO  50  T-IFIX(TMAX/DTIME) ,1,-1 
PRINT  * 

PRINT  COMPUTING  AT  TIME  ■* ,T*DTIME-DTIME 
PRINT  * 

READ  (10,R£O(T-l)*RECRAT+l)  CMXPOS,  CMYPOS 
PRINT  * , ' CMXPOS  , CMXPOS , '  CMYPOS  .CMYPOS 
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C  For  each  quantized  state,  call  the  subroutine  that  determines  the 
C  optimal  control  for  the  state  and  missile  position 

C 

DO  60  X-l.WX 

PRINT  *,*X  BLOCK  -\X 
XPOS  -  XM1N+{T-1)*DX 
DO  70  Y-1,WY 

YPOS  -  YMIN+CY-l )*DY 
DO  80  HDG-1,VHDG 

HDGPOS  -  HDGMIN+CHDG-l )*DHDG 
DO  90  VEL-l.WVEL 

YELPOS  -  VELMIN+(VEL-1)*DVEL 
CALL  CHKCNT 

OPTCNT(X,Y,HDG,VEL)  -  COPT 
90  CONTINUE 

80  CONTINUE 

70  CONTINUE 

60  CONTINUE 

C 

C  Save  the  optimal  controls  for  this  stage  after  all  quantised  states 
C  are  processed 

C 

WRITE  (l2,REC-(T*6)-5)  (SAVCON(l) , 1-1 , 1500) 

WRITE  ( 12 ,REC-(T*6)-4)  (SAVCON(I) , 1-1501 ,3000) 

WRITE  ( 12 ,REC-(T*6)~3)  (SAVCON(l) , 1-3001 ,4500) 

WRITE  ( 12,REC-(T*6)~2)  (SAVC0N (I >,1-4501,6000) 

WRITE  (12 ,REC-(T*6)-1)  (SAVCON(I), 1-6001, 7500) 

WRITE  ( 12 ,REC-(T*6) )  (SAVCON(I) , 1-7501 ,9000) 

C  * 

C  The  current  penalties  become  the  penalties  of  the  last  stage  in 
C  preparation  of  processing  the  nert  time  stage 

C 

DO  100  1-1,9000 

LPLAS(I)  -  LPNOW(I) 

100  CONTINUE 

50  C01TINUE 

C 

C  Save  the  last  penalties  in  the  proper  file 

r 

WRITE  (11,*)  (LPNOW(I), 1-1,9000) 

C 

C  Close  all  the  files 
C 

550  CLOSE  (10) 

CLOSE  (11) 

CLOSE  (12) 

RETURN 

END 


oooo  noo  noon  oooo 


g  **********************************************************************' 

C  '* 

C  *  SUBROUTINE:  CHXCNT 

C  * 

C  *  DESCRIPTION:  This  subroutine  determines  the  optimal  control 

C  *  for  the  current  stage  and  quantised  state. 

C  * 

C  ********************************************************************** 

SUBROUTINE  CRKCNT 

INCI,UDE  'SYS7AR.COM' 

INCLUDE  'DPVAR.COM' 


+ 

+ 

+ 


REAL 

NXTX,  NXTY, 

LOCPEN,  NXTPEN, 
PENS ( 16 ) 

NXTHDG,  NXTVEL, 

INTEGER 

I. 

J. 

K,  L,  N, 

XBAS, 

YBAS, 

HDGBAS,  VELBAS,  HADJ 

Initialize  the  optimal  control  to  zero  and  compute  the  penalty  for 
arriving  at  the  current  state 

COPT  -  0 

LOCPEN  -  PENLTY ( XPOS ,  YPOS , HDGPOS , CONTRL (  C ,  1 ) , 

+  C0NTRL(C,2),CMXP0S,CMYP0S,DTIME) 

For  each  control,  determine  the  state  of  the  next  stage  for  applying 
that  control 

DO  10  C-1,5 

om  -  XPOS  +  XCHG(HDG,VEL,C) 

NXTY  -  YPOS  +  YCRG(HDG, VEL.C) 

NXTHDG  -  HDGPOS  +  HDGCHG ( HDG , VEL , C ) 

NXTVEL  -  VELPOS  +  VELCHG(C) 

If  the  next  state  is  within  limits,  continue 

IF  ( NXTX . GE . XMIN . AND . NXTX . LE . XMAX . AND . 

+  NXTY.GE.YMIN. AND. NXTY. LE.YMAX. AND. 

+  NXTVEL. GE.VKLMIN. AND. NXTVEL. LE.VELMAX)  THEN 


Determine  the  nearest  quantized  state  to  the  state  that  will  be 
reached  if  the  control  is  applied 

XBAS  “  IFIX( (NXTX-XMIN) /DX+1 ) 

YBAS  -  IFIX( (NXTY-YMIN) /DY+1 ) 

HDGBAS  -  IP IX ( (NXTHDG- HDGMIN) /DHDG+1) 

7ELBAS  -  IFIX( ( NXTVEL- VELMIN ) /DVEL+1 ) 


nononoo  n  n  n  n  non  ooo 


Thi»  code  ensures  that  the  interpolation  will  not  try  to  interpolate 
from  a  point  not  within  limits  of  the  atate  constraints 

IP  (XBA5.EQ.VX)  XBAS  -  WX  -  1 
IP  (YBAS.EQ.VY)  YBAS  -  WY  -  1 
IF  (HDGBAS .EQ.WRDG)  THEN 
HADJ  -  1-WHDG 
ELSE 

HADJ  -  1 
KNDIF 

IF  (VELBAS .EQ.WVEL)  VELBAS  -  tfVEL  -  ) 


Load  the  array  used  for  interpolation. 

PENS(1)-PENLAS (XBAS, YBAS .HDGBAS, VELBAS) 
PENS(2)-PENLAS(XBAS,YBAS,HDGBAS, VELBAS+1) 

PENS (3) -PENLAS (XB AS, YB  AS, HDGBAS+HADJ, VELBAS) 

PENS ( 4 ) -PENLAS ( XBAS , YBAS , HDGBAS+HADJ , VELBAS+ 1 ) 

PENS ( 5 ) -PENLAS ( XB AS , YBAS+ 1 , HDGBAS , VELBAS ) 

PENS ( 6 ) -PENLAS ( XBAS , YBAS+1 , HDGBAS , VELBAS+1 ) 
PENS(7)«PENLAS(XBAS , YBAS+1 , HDGBAS+HADJ, VELBAS) 
P£NS(8)-PENLAS(XBAS, YBAS+1, HDGBAS+HADJ, VELBAS+1) 
PENS ( 9 ) -PENLAS ( XBAS+ 1 , YBAS , HDGBAS , VELBAS ) 

PENS( 10) -PENLAS (XBAS+1 , YBAS , HDGBAS , VELBAS+1 ) 

PENS ( 1 1 ) -PENLAS ( XBAS+1 , YBAS , HDCBAS+HADJ , VELBAS ) 

PENS ( 1 2 ) -PENLAS ( XBAS+1 , YBAS , HDCBAS+HADJ , VELBAS+ 1 ) 
PENS (13)-PENLAS(XBAS+1, YBAS+1, HDGBAS, VELBAS) 

PENS (14) -PENLAS ( XBAS+1 , YBAS+1 , HDGBAS , VELBAS+1 ) 

PENS ( 15 )-PENLAS  (XBAS+1, YBAS+1, HDGBAS+HADJ, VELBAS) 
PENS (16) -PENLAS (XBAS+1 , YBAS+1 fHDGBAS+HADJ, VELBAS+1 ) 

Determine  the  difference  between  the  next  state  and  the  nearest 
quantized  s .ate 

DIPF(l)  -  NXTVEL  -  ( VELMIN+ (VELBAS- 1 )*DVEL) 

DIFP(2)  -  NXTKDG  -  ( HDGMIN+ (HDGBAS- 1)*DHDG) 

DIPF(3)  -  NXTY  -  ( fHIN+(YBA5-l )*DY) 

DIFP(4)  -  NXTX  -  (XMIN+(XBAS-1)*DX) 


Interpolate  the  penalty  for  arriving  at  the  next  state 
NTTPEN  -  EST(DIFP ,DP0S , PENS ) 

If  no  allowable  control  found  so  far,  sake  this  the  optimal  control 
to  this  point  and  save  the  penalty 

IF  (COPT.EQ.O)  THEN 

PENNOtf ( X , Y , HDG , VEL )  -  LOCPEH  +  NTTPEN 
COPT  -  C 


n  nn  o  o  o  o 


Else  If,  the  total  penalty  for  this  control  is  less  than  any  previous 
control,  make  It  the  optimal  control  and  save  the  penalty 

ELS El F  (LOCPEW+NrrPEK.LT.PEHNOWOC.Y.HDG.VEL))  THEN 
PENNOV(X,Y,HDG,VEL)  -  LOCPEN  +  NXTPEN 
COPT  -  C 
END  IF 
ENDIF 

10  CONTINUE 

If  no  optimal  controls  found,  make  the  penalty  none  big  number 

IF  (COPT.EQ.O)  PENN0W( X , Y , HDG , VEL) "BIGNUM 

RETURN 

END 
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> 


ft 


ft 


C  ******************************* *************************************** 

c  * 


C  *  SUBROUTINE: 

C  * 

C  *  DESCRIPTION: 

C  * 

C  * 

C  4 
C  * 

C  4 

c  * 

c  * 


PRNTPP 

This  subrcjtine  retreives  the  optimal  controls 
and  aimulates  the  flight  of  CMMCA  as  it  tracks 
the  cruise  missile.  The  user  is  given  two 
options  of  starting  this  revrieval.  The 
initial  of  C*CiCA  can  be  explicitely  stated  or 
the  optimal  starting  position  can  be  found, 
results  of  the  simulation  are  displayed  to  the 
screen  and  saved  in  the  file  RESULTS.DAT. 


C  *  * 

c  *********************************************************************** 


SUBROUTINE  PRNTPP 


INCLUDE 

'SYSVAR.COM 

* 

INCLUDE 

'DPVAR.COH' 

INTEGER 

OPTS, 

OPTY, 

OPTHDG,  OPTVEL,  I,  J, 

TEAS, 

YBAS, 

HDGBAS ,  VELBAS,  HADJ, 

+ 

SAVCON(9000), 

CHOICE 

REAL 

LPNOVOOOO), 

LPLAS(9000) , 

+ 

BANK, 

THRUST, 

TEMP(16),  ROPT, 

+ 

RANGE, 

AZ, 

PHDG,  ALT,  DEV 

DOUBLE 

PRECISION 

NXTX, 

NXTY,  NXTHDG,  NTTVEL 

Two  1 -Dimensional  arrays  are  equivalenced  to  the  optimal  control  and 
penalty  arrays  for  ease  of  manipulation. 


EQUIVALENCE  ( SAVCON( l ) , 0PTCNT( 1 , 1 , 1 , 1 )  )  , 
+  (LPNOW( 1 ) ,PENNOW( 1,1, 1,1)) 


Open  the  files  containing  the  missile  position,  the  optimal  controls 
at  each  stage,  and  the  final  penalties.  Also,  initialize  the 
file  which  will  contain  the  results  of  the  simulation  of  the 
flight. 


+ 

+ 

+ 


OPEN  (UNIT-10, PILE-' CMPOSTN.DAT' , ACCESS-’ DIRECT' , 
STATUS-' OLD* , FORM" ' UNFORMATTED ' ,RECL-8) 

OPEN  (UNIT-11 .FILE- 'PENALTY.DAT' .ACCESS-' SEQUENTIAL* , 
STATUS -'OLD') 

OPEN  (UNIT-12, FILE- 'CONTROL. DAT' .ACCESS- 'DIRECT' , 
STATUS-' OLD' , FORK- ' UNFORMATTED ' ,RECL-6000) 

OPEN  (UNIT-13, FILE- 'RESULTS. DAT' , ACCESS- ' SEQUENTIAL ' , 
STATUS- 'NEW') 
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nnn  nonon  ooo  ooo 


Clear  the  screen,  display  the  aenu  end  read  the  user's  choice 


CALL  CLS 

print  200 

200  FORMAT  (3X,T 15, 'SUBROUTINE  DISPLAY  CMMCA  FLIGHT  PATH'//// 

+  1X,T16,’1  -  SET  CMMCA  STARTING  CONDITIONS'// 

+  1X,T16, '2  -  DP  OPTIMAL  SOLUTION*/// 

+  IX, T20, 'ENTER  CHOICE'/) 

READ  (*,*)  CHOICE 

Again,  clear  the  screen  and  display  a  working  aessage 
CALL  CLS 

PRINT  *, 'WORKING' 

PRINT  * 


Read  the  penalties  of  the  last  stage  and  initialise  the  altitude  of 
of  the  simulation.  Also,  initialise  the  array  containing  the 
size  of  the  increments  between  the  quantized  states. 


READ  (11,*)  (LPNOW(I), 1-1,9000) 

R0PT  -  15.0 

ALT  -  29000/6076 

DP0S(1)  “  DVEL 

DP0S<2)  -  DHDC 

DPOS  ( 3  )  -  DY 

DP0S ( 4 )  -  DX 


Read  the  set  of  optimala  controls  for  the  first  stage 


READ 

READ 

READ 

READ 

READ 

READ 


(12.REC-1) 

fn  p vrm'-i'i 

V  I  Si  / 

(12.REC-3) 
( 12 ,REC— 4) 
(12.REC-5) 
( 12 ,REC— 6) 


(SARCON(I), 1-1,1500) 

f  c  k  Ttnrws  /  r  N  t— i  cm 

v  wn  *  WVH  U  /  )1~1  -/V  A  |  JWVU  / 

(SAVCON(I), 1-3001, 4500) 
( SAVCON (I ) , 1-4 50 1 , 6000 ) 
( SAVC0N( I ) *  1-600 1,7500) 
(SAVCON(I) ,1-7501 ,9000) 
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u  u  o  o  o 


If  the  choice  1b  to  state  the  CMMCA  initial  state,  clear  the  screen 
and  request  starting  position,  heading,  and  airspeed.  Concert 
the  airspeed  to  na/min  and  heading  to  radians. 


IF  ( CHOICE. EQ. 1)  THEN 
CALL  CLS 

PRINT  205 

205  FORMAT  (///IX, ’ENTER  CMMCA  STARTING  POINT  (X  AND  Y)  -'/) 

READ  (*,*)NXTX,NXTY 

PRINT  210 

210  FORMAT  (//IX, 'ENTER  INITIAL  HEADING  (DEGREES)  -'/) 

READ  (*,*)  NXTHDG 

IF  (NXTHDG. GT. 180. 0)  NXTHDG  -  NXTHDG  -  360.0 
NXTHDG  ■  NXTHDG /I 80. 0*DPI 

PRINT  215 

215  PORMAT  (//IX, 'ENTER  INITIAL  VELOCITY  (KNOTS)  -'/) 

READ  (*,*)  NXTVEL 
NXTVEL  -  NXTVEL/60.0 
C 

C  Find  the  nearest  unantlted  state 
C 

XBAS  -  IFIX ( ( SNGL ( NXTX ) -XMIN ) /DX+ 1 ) 

YBAS  -  IFIX((SNGL(NXTY)-YMIN)/DY+1) 

HDGBAS  -  IFIX(  ( SNGL ( NXTHDG )-HDGMIN)/DHDG-tl ) 

VELBAS  “  IFIX(  (  SNGL  (  NXTVEL  )-VEUON)/DVEL+l ) 

IF  (XBAS.EQ.WX)  XBAS  -  WX-1 
IF  (YBAS. EQ. NY)  YBAS  -  NY-1 
IF  (HDGBAS. FQ.VKDG)  THEN 
HADJ  -  1-VHDG 
ELSE 

HADJ  -  1 
END  IF 

IF  (VELBAS. EQ.WVEL)  VELBAS  -  NVEL-1 
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non  o  o  o  o 


C  Load  the  array  for  interpolation  of  the  optiaal  bank  angle 
C 

TEMP < 1 ) -CONTEL ( OPTCNT (XBAS , YBAS , HDGBAS , VELBAS ) , 1 ) 
T1MP(2)-C0NTRL(0PTCNT(XBAS  ,Y1AS  .HDGBAS  , VELBAS+l) ,  1 ) 

T!MP( 3 )-CONTRL(OPTCNT(XBAS, YBAS, HDGBAS+HADJ, VELBAS)  ,  1 ) 
TEMP(4)-C0NTRL(0PTCNT(XB AS, YBAS, HDGBAS+HADJ, VELBAS+l) , 1) 

TEMP ( 5 ) -CONTEL ( OPTCNT < XBAS , YBAS+1 , HDGBAS , VELBAS ), 1 ) 

TEMP ( 6 )-CONTRL( OPTCNT ( XBAS , YBAS+1 , HDGBAS , VELBAS+l ), 1 ) 
TEHP(7)-C0NTRL(0PTCNT(XBAS, YBAS+1, HDCBAS+HADJ, VELBAS) , 1) 

TEMP ( 8 )-CONTRL( OPTCNT (XBAS  ,  YBAS+1 ,  HDGBAS+HAD J ,  VELBAS+l ) ,  1 ) 
TEMP ( 9 )' -CONTEL ( OPTCNT ( XBAS+ 1 , YBAS , HDGBAS , VELBAS ), 1 ) 

TEMP ( 1 0 ) -CONT&L ( OPTOTT  ( XBAS+ 1 , YBAS , EDGBAS , VELBAS+ 1 ), 1 ) 

TEMP ( 1 1 ) -CONTRL( OPTCNT ( XBAS+ 1 , YBAS , HDGBAS+HADJ , VELBAS ), 1 ) 

TEMP  ( 12 )-C0NTRL( OPTCNT (XBAS+1 , YBAS, HDCBAS+HADJ, VELBAS+l) ,  1) 
TEMP(13)-C0NTRL(0PTCNT(XBAS+1,  YBAS+1, HDGBAS,  VELBAS),  1) 
TEMP(14)-CONTRL(OPTCNT(XBAS+l  .YBAS+l , HDGBAS, VELBAS+l) ,  1) 
T2MP(1 5 )-CONTRL( OPTCNT (XBAS+1 , YBAS+1 , HDGBAS+HADJ , VELBAS ) ,1) 
TEMPO  6  )-C0NTRL  (OPTCNT  (XBAS+1 .YIAS+l , HDGBAS+HADJ, VELBAS+l) , 1) 


Compute  the  difference  between  the  requested  state  and  the  nearest 
quantized  state.  Then  interpolate  the  optical  bank  angle. 

DIFP(l)  -  SNGL(NXTVEL)  -  ( VELMIN+ ( VELBAS- 1 ) *DVEL ) 
DIFPC2)  -  SNGL(NXTHDG)  -  ( HDGMIH+( HDGBAS- 1 )*DHDG) 
DIFF(?)  -  SNGL(NXTY)  -  (YMIN+(TBAS-1)*DY) 

DIPP(4)  -  SNGL(NXTX)  -  (XMIN+(XBAS-1)*DX) 

BANK  -  EST ( DI FF , DPOS , TEMP ) 


Load  the  array  for  the  interpolation  of  the  optimal  thrust  control. 
Then  interpolate  the  optimal  thrust  control. 

C 

TEMP C 1 )-C0NTRL < OPTCHT ( XBAS , TEAS , HDGBAS , VELBAS ), 2 ) 

TEMP ( 2 ) -CONTEL ( OPTCNT ( XBAS , YBAS , HDGBAS , VELBAS +1 ), 2 ) 

TEMP ( 3 ) -CONTEL ( OPTCNT ( XBAS , YBAS , HDCBAS+HADJ , VELBAS ), 2 ) 

TEMP ( 4 ) -CONTEL ( OPTCNT ( XBAS , YBAS , HDCBAS+HADJ , VELBAS+ 1 ), 2 ) 

TEMP ( 5 ) -CONTEL ( OPTCNT ( XBAS , YBAS+ 1 , HDGBAS , VELBAS ), 2 ) 

TEMP  ( 6 )-CONTKL( OPTCNT (XBAS .TBAS+l ,KDGBAP, VELBAS+l ) ,2) 

TEMP ( 7 ) -CONTEL ( OPTCNT ( XBAS , YBAS+ 1 , HDGBAS+HADJ , VELBAS ), 2 ) 

TEMP  (  8  ) -CONTEL  (  OPTCNT  ( XBAS ,  7BAS+ 1 ,  HDGBAS+HADJ ,  VELBAS+l ),  2 ) 
TEMP  (  9  )' -CONTEL  (  OPTCNT  ( XBAS+ 1 ,  YBAS ,  HDGBAS ,  VELBAS  ),  2  ) 

TEMP UO) -CONTEL (OPTCNT (XBAS+1, YBAS, HDGBAS, VELBAS+l),?) 

TWP(  11  )-CONTRL  (OPTCNT  (XBAS+1 , YBAS , HDGBAS+HADJ. VELBAS)  ,2) 

TEMP  ( 1 2  ) -CONTEL  (  OPTCNT  ( XBAS+ 1 ,  YBAS ,  HDGBAS+HADJ ,  VELBAS+l ),? ) 
TEMP  ( 1 3  ) -CONTEL  ( OPTCNT  ( XBAS  1 1 ,  YLAS4 1 ,  HDGBAS ,  VELBAS  ),  2  ) 

TEMP  ( 14) -CONTEKOP1  C1!T  ( XBAS+1 ,  YBAS+1 ,  HDG1AS ,  VELBAS+l ),  2  ) 

TO(P  ( 1 5  ) -CONIEL(OPTOn  ( XBAS+ 1 ,  YBAS+1 ,  HDCBAS+HADJ ,  VELBAS  ),  2  ' 
TEMP (16) -CONTEL ( OPTCNT (XBAS+1 , YBAS+1 , HDGBAS+HADJ, VELBAS+l) ,2) 


THRUST  -  EST (DIFT, DPOS, TEMP) 


C  Else  determine  the  quantized  state  that  results  in  the  least  penalty 
C 

ELSE 

om-i 

OPTY-l 
OPTHDG- 1 
OPTVEL-1 
DO  20  X-l.VX 

DO  30  Y“1,WY 

DO  AO  HDG-1 ,WHDG 

DO  50  VEL-l.WVEL 

IF  (PENNOW(X,Y, HDG.VED.LT. 

+  PENNOWCGPTX, OPTY, OPTHDG, OPTVEL) )  THEN 

OPTX  *  X 
OPTY  “  Y 
OPTHDG  -  HDG 
OPTVEL  -  VEL 
ENDIF 

50  CONTINUE 

40  CONTINUE 

30  CONTINUE 

20  CONTINUE 

C 

C  Establish  the  starting  position  and  optimal  controls 

C 

NXTX  -  DBLE(XMIN  +  (0PTX-1)*DX) 

NXTY  -  DBLECYMIN  +  (0?TY-1)*DY) 

NXTHDG  -  DBLECHDGMIN  +  (OFTHDC-1 )*DHDG) 

NXTVEL  -  DBLE( VEIXIN  +  (0PTVEL-1)*DVEL) 

BANK  -  CONTRLCOPTCNT COPTX, OPTY, OPTHDG, OPTVEL ),1) 

THRUST  -  CONTRL ( OPT CNT (OPTX, OPTY .OPTHDG, OPTVEL) ,2) 

ENDIF 

C 

C  Read  the  first  missile  position,  and  calculate  the  parameters  to 
C  be  displayed  on  the  screen.  Calculate  the  initial  deviation. 

C 

READ  (10.REC-1)  CMXPOS , CMYPOS 

PHDG  -  NXTHDG* 180. 0/PI 
IF  (PHDG.LT.O)  PHDG  -  PHDG  +  360.0 

PANGE  -  SQRT((NXTX-CMXPOS)**2+(NXTY-CMYPOS)**2+ALT**2) 

AZ  -  AT AN2( CMXPOS -NXTX, CMYPOS -NXTY)  -  NXTHDG 

IF  (AZ.GT.PI)  A2  -  AZ  -  2*PI 

IF  (AZ.LT.-PI)  AZ  -  AZ  +  2*FI 

DEV  -  (ABS(ROPT-RANGE)+ABS (RANGE*AZ) )*DTIMI 


o  n  o  o  o 


Display  the  header  and  the  initial  conditions 


100 

+ 

+ 

+ 

+ 

+ 

+ 

+ 

105 

+ 


WRITE  (*,100) 

WRITE  (13,100) 

FORMAT  (IX,’  CMMGA  PARAMETERS  CONTROLS 

’  MISSILE  P0S  PERFORMANCE'/ 

lX.'TNOW  XPOS  YPOS  HDG  VEL  BANK  THRUST' , 
'  CKX  CMY  RANGE  AZIMUTH’/) 

WRITE  (*,105)  TEMP(l) *0.0, NXTX, NXTY, PHDG, NXTVEL*6Q.C, 

BANK* 130.0 /PI, THRUST,  CMXPOS,  CMYPOS, 

RANGE, AZ* 180.0 /PI 

WRITE  (13,105)  TEMP ( 1 ) *0 . 0 , NXTX , NXTY , PHDG , NXTVEL*60 . 0 , 

BANK* 180.0 /PI, THRUST,  CMXPOS,  CMYPOS, 

RANGE, A2*180. 0/PI 


FORMAT 


( 1 X , F4 . 2 , 2X , F6 . 3 , 2X ,f 6 . 3 , 2X , F4 . 0 , 2X , FA . 0 , 2X , F5 . 1 , 2X , 
F5.2,2X,F6.3,2X,F6.3,2X,P5.2,2X,F7.2) 


For  each  stage,  apply  the  optimal  controls 


For 


DO  60  J«2,IFIX(TMAX/DTIME+1) 

CALL  NEVPOS (NXTX, NXTY, NXT HOG, NTT  VEL, BANK, THRUST, 

DTIME /RECRAT ) 


each  of  the  intermediate  missile  position#  in  the  stage, 
simulate  flight  and  compute  for  display  the  performance 


+ 

+ 


+ 

+ 


DO 


65  K- 1, RECRAT- 1 

READ  ( 10, REC"(J-2) *RRCRAT+K+1)CMXP0S, CMYPOS 
PHDG  “  SNGL(NXTHDG)*180.0/PI 
IF  (PHDG.LT.0)  PHDG  -  PHDG  +  360.0 

range  -  sqrt(<sngl(nxtx)-ckxpos)**2+ 

(SHGL(NXTY)-CMYPOS)**2+ALT**2) 

A2  -  AT AN 2 (CMXPOS-SNGL(NXTX) ,CMYFOS-SNGL(NXTY) )- 

SNGL(NXTHDG) 

IF  (AZ.GT.PI)  AZ  -  AZ  -  2*PI 
IF  (AZ.LT.-PI)  AZ  -  AZ  +  2*PI 

DEV  -  DEV  +  (ABS(ROPT-RANGE)+ABS(RANGE*AZ))*DTIME 
WRITE  (*,105)  (J-2)*DTIME+K*DTIME/RECRAT, NXTX, NXTY, 
PHDG , NXTVEL*60 . 0 , BANK* 1 80 . 0 /PI , THRUST 
CMXPOS , CMYPOS , RANGE , AZ* 1 80 . 0 /PI 
WRITE  (13,105)  (J- 2 )*DTIME+K*DTIME /RECRAT, NXTX, NXTY, 
PHDG, NXTVEL*6O.0, BANK* 180. 0/PI , THRUST 
CMXPOS , CMYPOS .RANGE, AZ*180. 0/PI 


CALL  NEWF0S( NXTX, NXTY, NXTHDG , VXTVEL , BANK, THRUST, 

DTIME /RECRAT) 
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CONTINUE 


o  o  o 


r  Read  Che  next  missile  position  end  coapute  performance  parameters 
C 

READ  (10,R£C-(J-1)*REQAT+1)  CMXPOS.CMYPOS 

PHDG  -  SNGL(NXTHDG)*180.0/PI 
IF  (PHDG.LT.O)  PHDG  -  PHDG  +  360.0 
RANGE  -  SQRT(  (GNGL(NXTT)-CMXP0S)**2+ 

+  (SNGL(NXTY)-CMYP0S)**2+ALT**2) 

AZ  -  ATAN2(CMXP0S-SNGL(fflmt),CMYP0S-SHGLC?nrrY))- 
+  SNCL(NXTKDG) 

IF  (AZ.GT.PI)  AZ  -  AZ  -  2*PI 
IF  (AZ.LT.-PI )  AZ  -  AZ  +  2*PI 

DEV  “  DEV  +  (ABS(ROPT-KANGE)+ABS(RANGE*AZ))*DTIME 

If  this  is  not  the  last  stage,  get  the  next  set  of  optimal  controls 
and  interpolate  the  next  optimal  control  in  the  same  procedure 

C  as  above 

C 

if  (j.lt.ifix(tmax/dtime+D)  then 

READ  (12,REC-(J*6)-5)  (SAVCON(I) ,1-1,1500) 

READ  ( 12 ,REC— ( J*6)-4)  (SAVCON(I)  .1-1501 ,3000) 

REaD  (12,REj:-(J*6)-3)  (SAVCON(I), 1-3001,4500) 

READ  ( 12,REC— (J*6)-2)  (SAVCON(I) ,1-4501 ,6000) 

READ  ( 12 ,REC-( J*6)-l)  (SAVCON(I) ,1-6001 . 7500) 

READ  ( 12 ,REC-( J*6))  (SAVCON(I) ,1-7501 ,9000) 

XBAS  -  IFIX( (SNGL(NXTX)-XMIN) /DX+1 ) 

YBAS  -  IFIX( (SNGL(NXTY)-YMIN) /DY+1) 

HDGBAS  -  IFIX( (SNGL(NXTHDG)-HDGMIN) /DHDG+1 ) 

VELBAS  -  IFIX((SNGL(NXTVEL)-VELHIN)/DVEL+1) 

IF  (XBAS.EQ.VX)  XBAS  -  WX-1 
IF  (YBAS.EQ.VY)  YBAS  -  VY-1 
IF  (HDGBAS.EQ.WHDG)  THEN 
HADJ  -  1-WHDG 
ELSE 

HADJ  -  1 
END  IF 

IF  ( VELBAS. EQ.WEL)  VELBAS  -  WVEL-1 


TSHP(  1  )*CQNTKL(OPTCNT(XBAS ,YBAS, HDGBAS .VELBAS)  ,  1 ) 

TEMP  {  2  ) -COWTRI,  (  OPTCKT  C  XBAS  ,  YSAS ,  HDGBAS ,  VELBAS+ 1 ) ,  1 ) 

TEMP  (3  y^CONTRLC  OPTCHT  (XBAS,  YBAS,  HDGBAS+HADJ,  VELBAS)  ,  1 ) 
TEMPCA)-C0NTRL(0?TCIIT<3tlAS ,  YBAS , HDGBAS+HADJ  , VELBAS+1 ) ,  1 ) 
TEMP(5)*CGHTRL(0PTCHT(XBAS, YBAS+1  ,HDGBAS,VELBAS) , 1) 

TEMP ( 6 )-C0NTRL( OPTCHTCXBAS , YBAS+ 1 , HDGBAS , VELBAS+1 ) ,  1 ) 

TEMP(7 )*COHTRL(OPTCJTr(XBAS , YBAS+1  , HDGBAS+HADJ .VELBAS ) ,  1 ) 
T1MP(8)-CONTRL(OPTCHT(XBA£ ,  YBAS+1  , HDGBAS+HADJ ,  VELBAS+1 ) ,  1 ) 
TEMP(9)-C0NTRL(OPTCMTOBAS+l ,YBAS , HDGBAS .VELBAS) , 1 ) 

TIMP( 10)-CONTRL(0PTCMT(XBAS+l , YB AS , HDGBAS, VRLBAS+1 ),1) 
TSMP(ll)-COmL(OPTCST(XBAS+l  ,YBAS , HDGBAS+HADJ, VELBAS)  ,  1 ) 

TEMP  ( 1 2  ) -COHTtL  (OPTOfl  (  XBAS+1 ,  YBAS ,  HDGBAS+HADJ ,  VELBAS+ 1 ) ,  1 ) 
TEMP(  13)-€OKTRLCOPTCKT(mS+l ,  YBAS+1  .HDGBAS , VELBAS) ,  1 ) 

TEKP(  14)-C0HT&L(0PTCHT(XBAS+1  ,YBAS-»-l ,  HDGBAS ,  VELBAS+1 ),  1) 
TEMP(15)“CONTRL(OPTCNT(XBAS+l , YBAS+1 , HDGBAS+HADJ, VELBAS ),1) 
TEMP( 16)-COWTRL(OPTCNT(XBAS+l , YBAS+1 , HDGBAS+HADJ .VELBAS+1 ) , 1 ) 

DIFF(l)  -  SWGL(NXTVEL)  -  ( VELMIN+C VELBAS- 1)*DVEL) 
DIFFC2)  -  SMGL(MXTHDG)  -  ( HDGMIN+C HDGBAS- 1)*DHDG) 
D1FFC3)  -  SMGL(NXTY)  -  (YMIN+(YBAS-1)*DY) 

DIFF(4)  -  SMGL(NTnC)  -  (XMIW+(XBAS-1)*DX) 

BANK  -  EST(DIFF,DPOS ,TEhP) 

TEMP( 1 ) "CONTRL ( OPTCHT (XBAS , YBAS, HDGBAS .VELBAS ) , 2 ) 

TEMP ( 2 )«CONTRL(OPTCMT(XBAS , YBAS .HDGBAS , VELBAS+1 ), 2 ) 

TEMP ( 3 ) “CONTRL ( OPTCHT (XBAS , YBAS , HDGBAS+HADJ , VELBAS ) ,2) 
TEMP(4)-C0NTRL(0PTCHT(XBAS, YBAS, HDGBAS+HADJ, VELBAS+1), 2) 
TEMP(5)“CONTRL(OPTCNT(XBAS , YBAS+1 , HDGBAS .VELBAS) ,2) 
TEMP(6)-CONTRL(OPTCNT(XBAS .YBAS+1 .HDGBAS, VELBAS+1 ) ,2) 
TEMP(7)”COHTRL(OPTCNT(XBAS, YBAS+1 .HDGBAS+HADJ, VELBAS) ,2) 
TEKP(8)-C0NTRL(0PTCIfr(XBAS .YBAS+1 , HDGBAS+HADJ, VELBAS+1 ), 2 ) 
TEMP ( 9 ) -CONTRL ( OPTCMT ( XBAS+ 1 , YBAS , HDGBAS , VELBAS ), 2 ) 
TEMP(10)-COHTRL(OPTCNT(XBAS+1 .YBAS, HDGBAS, VELBAS+1) ,2) 

TEMP( 11 )-CONTRL(OPTCHT(XBAS+l , YBAS, HDGBAS+HADJ, VELBAS) ,2) 
TEMP(12)-CONTRL(OPT CUT (XBAS+1 , YBAS, HDGBAS+HADJ, VELBAS+1) ,2) 
TEMP ( 13 )-CONTRL( OPTCMT (XBAS +1 , YBAS+1 .HDGBAS, VELBAS) ,2) 

TEMP  (14)*C0NTRL(0PTCNT( XBAS+1 , YBAS+1 .HDGBAS, VELBAS+1 ), 2) 

TEMP  ( 15 )*CONTRL(OPTCNT (XBAS+1 , YBAS+1 , HDGBAS+HADJ , VELBAS )  ,2) 
TEMP ( 16 )*CONTRL( OPTCMT (XBAS+1 , YBAS+1 , HDGEAS+HADJ , VELBAS+ 1 ) ,2) 

THRUST  -  EST(DIFF,DPOS,TEMP) 


Display  the  reault* 

WRITE  (*,105)  (J-1)*DTIME,NXTX,NXTY,PHDG, 

+  NXTVEL* 60.0, BANE* 180. 0/PI, THRUST, 

+  CMXPOS ,CMYPOS,IAMGE,AZ*180.0/PI 

WRITE  (13,105)  ( J- 1 ) *DT IME , NXTX , NXTY , PHDG , 

fiAi»CiL"Ou.utDA/iK^iOU.u/ri,inaiuoi> 

CMXPOS , CWYPOS, RANGE, AZ* 180.0 /PI 


+ 


UUUO  u  U  U  5JOU 


Else  the  lest  stage  has  been  reached.  Displnv  on  the  final  position 
and  performance  parameters  along  vlth  average  deviations 

ELSE 

WRITE  (*,110)  ( J-1)*DTIM£,NXTX,NXTY,PHDG, 

NXTVEL*60 . 0 ,  CMXPOS ,  CMYPOS , 

RANGE, AZ*1 80. 0/PI 

WRITE  (13,110)  (J-l)*DTIME,Nm,NXTY,PHDG, 

NXTVEL*60 . 0 ,  CMXPOS ,  CMYPOS , 

RANGE, AZ* 180,0 /PI 

FORMAT  aX,F4.2,2X,P6.3,2X,F6.3,2X,F4.0,2X,F4.0,16X, 
F6.3,2X,F6.3,2X,F5.2,2X,F7.2) 

PRINT  * 

PRINT  * , 1 AVERAGE  TIME  WEIGHTED  DEVIATIONS  FROM', 
'DESIRED  POSITION  -'.DEV/TMAX 
WRITE  (13,*) 

WRITE  (13,*)  'AVERAGE  TIME  WEIGHTED  DEVIATIONS  FROM’ , 
'DESIRED  POSITION  -', DEV/TMAX 

ENDIP 
60  CONTINUE 

Hold  program  execution  until  the  user  is  ready  to  continue 

PRINT  * 

PRINT  * 

PRINT  *, 'PRESS  <ENTER>  TO  CONTINUE’ 

READ  (*,*) 


+ 


+ 


+ 

+ 

+ 

+ 

no 

+ 


Close  all  files 

CLOSE  (10) 
CLOSE  (11) 
CLOSE  (12) 
CLOSE  (13) 

RETURN 

END 


66 


noon  noon 


C  a**************************************** s»*a****************»*<nHMHH**i 

C  *  ' 

C  *  SUBROUTINE:  INTPRM 

C  * 

C  *  DESCRIPTION:  This  subroutine  initializes  the  paraaeters  used 

C  *  throughout  the  program. 

C  * 

q  ********************************************************************** 

SUBROUTINE  INTPRM 

INCLUDE  'SYS VAR. COM’ 

C 

C  BIGNUM  is  the  psuedo-penalty  when  no  allowable  controls  exist 
C  RECRAT  is  the  number  of  aissile  position  recorded  in  each  stage 
C  PI  la  the  value  of  pi 

C  DPI  is  the  value  of  pi  in  double  precision 
C 

BIGNUM-100 000.0 
RECRAT  -  5 
PI  -  ACOSC-l.O) 

DPI  -  DACOS(DBL£(-l .0) ) 

These  variables  define  the  Halts  of  the  state  space  for  x  position, 
y  position,  heading,  and  velocity. 


XMIN  - 

0.0 

XHAX  - 

28.0 

YMIN  - 

0.0 

YMAX  - 

28.0 

HDGMIN 

-  -PI 

HDGMAX 

-  PI 

VELMIN 

-  330.0/60.0 

VELMAX 

-  470.0/60.0 

These  variables  define  the  size  of  the  increment  for  each  state 
variable 


DX  -  2 
DY  -  2 
DHDG  -  PI/4 

DVEL  -  (7ELKAJ-VELMIN)/4 
DTIKE  -  .5 
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These  variables  contain  the  nuaber  of  quantised  states  in  the  state 
apace  for  each  state  variable 

VX  -  15 
WY  -  15 
WHDG  -  8 
WVEL  -  5 

The  bank  and  thrust  values  for  each  allowable  control  initialized 

Control  1  -  No  turn.  No  acceleration 
CONTRL(l.l)  -  0.0 
C0NTR1(1,2>  -  0.0 

C  Control  2  -  Right  turn.  No  acceleration 

C0NTRL(2,1)  -  30. 0/180. 0*PI 
C0NTRL(2,2)  -  0.0 

C  Control  3  -  Left  turn,  No  acceleration 

C0NTRL(3,1)  -  -30. 0/130. 0*PI 
C0NTR1(3,2)  -  0.0 

C  Control  4  -  No  turn,  Max  acceleration 

C0NTRLC4.1)  -  0.0 
C0NTRL(4,2)  -  1.0 

C  Control  3  -  No  turn,  Max  deceleration 

C0NTRL(5,1)  -  0.0 
CONTRL(5,2)  -  -1.0 

RETURN 

EN1) 
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C  a********************** ******************** ft******.*,:******** ********* 

C  * 

C  *  SUBROUTINE:  INTDP 

C  * 

C  *  DESCRIPTION:  This  subroutine  initializes  the  variables  used  ' 

C  *  primarily  in  the  dynamic  programming 

C  *  computation  of  the  optimal  controls. 

o  * 

C  ****************************************************** n*************** 


SUBROUTINE  INTDP 


INCLUDE  ’SYSVAR.COM' 

INCLUDE  ’DPVAR.COM’ 

DOUBLE  PRECISION  NXTX,  NXTY,  NXTHDG,  NXTVEL 

PRINT  *, ’ INITIALIZING  ARRAYS' 

PRINT  * 


Initialize  the  array  containing  the  size  of  the  increments  of  each 
state  for  interpolation  purposes. 


DP0S(1)  -  DVEL 
DP0S(2)  -  DHDG 
DP0S(3)  -  DY 
DP0S(4)  -  DX 


For  each  of  the  controls,  determine  the  magnitude  of  the  change 
for  each  state  variable.  The  value  of  this  change  1b 
independent  of  the  stage.  Thus,  this  cnaoge  can  be 
predetermined . 

DO  10  C-1,5 

DO  20  HDG-l.WHDG 

HDGPOS  -  HDGMIN+(HDG-I )*DHDG 
DO  30  VEL-l.WEL 

VELPOS  -  VELMIN+(7ZL-1)*DVEL 
NXTX  -  DBLE(O.O) 

NXTY  -  DBLE(O.O) 

NXTHDG  -  DBLE(HDGPOS) 

NXTVEL  -  DBLE(VELPOS) 

CALL  NEVP0S (NXTX, NXTY, NXTHDG, NXTVEL, 

+  C0NTRL(C,1),C0NTRL(C,2),DTIME) 

XCHG ( HDG , VEL , C )  -  SNGL(NXTX) 

YCHG ( HDG , VEL , C )  -  SNGL(NXTY) 

HDGCHG ( HDG , VEL , C )  -  SNGL (NXTHDG) -HDGPOS 
30  CONTINUE 

20  CONTINUE 

VELCHG(C)  *  SNGL ( NXTVEL )-VELP0S 
1C  CONTINUE 

RETUPN 
END 
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C  ««*iittt**t*«t*****t**«**tt*t««**)«i****t**m«  ************************* 


C  *  * 

C  *  SUBROUTINE:  NEVPOS  * 
C  *  * 
C  *  DESCRIPTION:  For  a  given  position  and  controls,  simulate  the  * 
C  *  the  flight  of  CMHCA  for  the  appropriate  time.  * 
C  *  * 


C  ****•*************************<<**************************************** 

SUBROUTINE  1TEV?0S(XP ,  Y?  ,HP,  VP  ,BK,TH,DT) 


DOUBLE 

PRECISION 

XP, 

YP, 

HP,  VP 

REAL 

BK, 

TH, 

DT 

REAL 

TANBK, 

PI, 

TIMINC, 

STEPTM,  ACCEL,  G 

INTEGER 

MXSTEP 

C 

C  Initialize  the  variables 

C  Max  acceleration  for  the  dynamic  program  is  defined  here. 

C  currently  set  at  30  knots  per  minute 

C  G  — >  32.2  ft/eec**2  -  19.32  na/min**2 

C 

TANBK  -  TAN(BK) 

PI  -  ACOS(-l.O) 

TIMINC  -  DT/10 
ACCEL  -  30.0/60.0 
G  -  19.32 
C 

C  Determine  the  number  of  whole  time  increments  in  the  time  frame 
C  requested  and  simulate  flight  that  number  of  increments. 

C 

MXSTEP  -  IFIX(DT /TIMINC) 

STEPTH  -  DT  -  MXSTEP*T IMINC 

XP  -  XP  +  (VP*DSIN(HP)-KJ«TANBK*DCOS(HP)*STEPTM)  *  STEPTM 
YP  »  YP  +  (VP*DCOS(HP)-G*TANBK*DSIN(HP)*STEPTM)  *  STEPTM 
HP  -  HP  +  (G*TANBK/VP)  *  STEPTM 
VP  -  VP  +  (ACCEL*TH)  *  STEPTM 


DO  10  1-1, MXSTEP 

XP  -  XP  +  (VP*DSIN(HP)+G*TANBK*DCOS(HP)*TIMINC)#TIMINC 
YP  -  TP  +  ( VP*DC0S ( HP ) — G*TANBK*DS IN ( HP ) *TIMINC ) *TIMINC 
HP  -  HP  +  (G*TANBK/VP)  *  TIMINC 
VP  -  VP  +  (ACCEL *Tfl)  *  TIMINC 
10  CONTINUE 

C 

C  Correct  the  heading  to  lie  betvee  -PI  and  PI 
C 

IP  (HP.LT.-PI)  HP  -  HP  +  2*PI 
IF  (HP.GT.PI)  HP  -  HP  -  2*PI 


END 


RETURN 
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C  *****ft***ft******«***************:Ht********************ft*4k*****ft****«*' 

C  * 

C  *  FUNCTION:  EST 

C  * 


C  *  DESCRIPTION: 

C  * 

C  * 

C  * 

c  * 
c  * 
c  * 
c  * 
c  * 


This  function  performs  the  linear  inter¬ 
polation.  The  sixteen  values  froa  which  the 
interpolation  is  to  be  performed  is  loaded  into 
the  array  VAL.  The  difference  between  the 
the  points  which  define  the  values  in  VAL  and 
the  requested  point  is  loaded  in  ADJ .  The  site 
of  the  increaents  between  the  established 
values  is  loaded  ir>  DP. 


C  ************ ********** ******** ******************************* ********* 


REAL  FUNCTION  EST (ADJ, DP, VAL) 


REAL  ADJ(4),  DP(4),  VAL(16) 


VAL(l)  -  VAL(l)  +  (VAL(2)-VAL(1))/DP(1)*ADJ(1) 
VAL(3)  -  VAL(3)  (VAL(4)-VAL(3))/DP(1)*ADJ(1) 
VAL(5)  -  VAL(5)  +  (VAL(6)-VAL(5))/DP(1)*ADJ(1) 
VAL(7)  -  VAL(7)  +  (VAL(8)-VAL(7>) /DP(1)*ADJ(1) 
VA1(9)  -  VAL(9)  +  (VAL(10)-VAL(9))/DP(1)*ADJ(1) 

VAL (11)  -  VAL(ll)  +  (VAL(12)-VAL(ll))/DP(l)#tADJ(l) 
VAL( 13)  -  VAL(13)  +  (VAL(14)-VAL(13))/DP(1)*ADJ(1) 
VAL( 15)  -  VAL( 15)  +  (VAL(16)-VAL(15))/DP(1)*ADJ(1) 

VAL(l)  -  VAL(l)  +  (VAL(3)-VAL(1))/DP(2)*ADJ(2) 

VAL( 5)  -  VAL(5)  +  (VAL(7)-VAL(5) ) /DP(2)*ADJ(2) 
VAL(9)  -  VAL(9)  +  (VAL(11)-VAL(9))/DP(2)*ADJ(2) 
VAL(13)  -  VAL( 13)  +  (VAL(15)-VAL(13))/DP(2)*ADJ(2) 

VAL(l)  -  VAL(l)  +  (VAL(5)-VAL(1))/DP(3)*ADJ(3) 
VAL(9)  -  VAL(9)  +  (VAL(13)-VAL(9) )/DP(3)*ADJ(3) 


EST  -  VAL(l)  +  (VAL(9)-VAL(1))/DP(4)*ADJ(4) 


RETURN 

END 
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C  **ftft**ft*ft*«ft»**ft»**ftft***»ftftftft*****ftftft***ft*ftft*ft******ftft**ftftft**e*****ft#* 

c  * 

PENLTY 


C  * 
C  * 

c 
c 
c 
c 
c 


FUNCTION: 

DESCRIPTION: 


This  function  determines  the  penalty  for 
the  current  position  of  the  CMMCA  and  the 
missile. 


a************************* * ************** «*•***•**«** •***«*•*****•**** 

REAL  FUNCTION  PENLTY(XPOS,YPQS ,KDG,BNK,THR,CHX,CMY,DT) 


REAL 

XPOS, 

YP0S, 

HDG  , 

+ 

BNX, 

TKR, 

+ 

CMX  i 

CHY, 

+ 

DT 

REAL 

RANGE, 

AZ, 

RNGOPT,  ALT,  PI 

Initialize  the 

optimal  range 

and  the 

altitude  of  CMMCA 

RNGOPT  -  15.0 
ALT  -  29000.0/6076 
PI  *  ACOS(-l.O) 


Compute  the  range  and  azimuth  of  the  missile  as  seen  on  the 

radar  scope.  If  the  CMMCA  is  directly  above  the  missile, 
assume  an  azimuth  of  PI. 

RANGE  -  SQRT( (XPOS~CMX)**2+(YPOS-€MY)**2) 

IP  ( CHX-XPOS . NE . 0 . 0 . OR . CMY-YPOS .  NE .  0 . 0  )  THEN 
A 2  -  AT AN 2 ( CMX-XPOS , CMY-YPOS )  -  HDG 
IF  CAZ.LT .-PI)  AZ  -  AZ  +  2*PI 
IF  (AZ.GT.PI)  AZ  -  AZ  -  2*PI 
ELSE 
AZ  -  PI 
ENDIF 


Compute  the  penalty 

PENLTY  -  (ABS (RANGE -RNGOPT)  +  ABS ( AZ*RANGE) )  *  DT 

RETURN 

END 
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£  ******************«*«*********«***************************************: 
C  * 

C  *  SUBROUTINE :  CLS 

C  * 

C  *  DESCRIPTION:  Clear*  tbe  screen  by  writting  26  blank  lines. 

C  * 

£  a********************************************************************* 

SUBROUTINE  CLS 

INTEGER  LYNE 

DO  10  LYNE-1,26 
PRINT  * 

10  CONTINUE 

RETURN 

END 
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***•**************************************************£',<***************** 
*  * 

*  Theae  are  the  common  block*  that  were  included  in  the  source  code.  * 

*  * 


************************************************************************* 

’SYSVAR.COM' 


C0MM0N/SYSVAR/ 

XMIN, 

YMIN, 

HDGMIN,  VELMIN, 

+ 

XMAX, 

YMAX, 

HDGMAX,  VELMAX,  TMAX, 

+ 

DX, 

DY, 

DHDG,  DVEL,  DTIME 

+ 

WX, 

VY, 

WHDG,  WVEL, 

+ 

RECRAT, 

PI. 

DPI,  CONTRL, 

+ 

BIGNUM 

INTEGER  WX, 

VY, 

WHDG , 

WVEL, 

+ 

RECRAT 

REAL  XMIN. 

YMIN, 

HDGMIN , 

VELMIN, 

+ 

XMAX , 

YMAX , 

HDGMAX, 

VELMAX,  TMAX, 

+ 

DX, 

DY, 

DHDG, 

DVEL,  DTIME, 

+ 

PI. 

CONTRL (5,2), 

BIGNUM 

DOUBLE  PRECISION  DPI 

'CMVAR.COM' 


COMMON/ CMVAR/ 

XPOS, 

YPOS , 

+ 

NEXTX, 

NEXTY, 

+ 

ETE, 

ETA, 

+ 

TNOW, 

TRECRD, 

+ 

BANK, 

r» 

+ 

SPEED, 

HEADNG , 

t 

XSPEED, 

YSPEED, 

+ 

TIMINC 

REAL 

ETE, 

ETA, 

+ 

TNOV, 

TRECRD, 

+ 

TURNRD, 

NEXTRD, 

+ 

BANE, 

G, 

+ 

TIMINC 

DOUBLE 

PRECISION 

XPOS, 

YPOS, 

+ 

NEXTX, 

NEXTY, 

+ 

SPEED, 

HEADNG 

+ 

XSPEED, 

YSPEED 

•DPVAR.COM 


COMMON / DP VAR /  X, 


+ 

XPOS, 

+ 

XCHG , 

+ 

CMXPOS 

+ 

DPOS , 

+ 

PENLAS 

INTEGER 

X, 

Y, 

+ 

C, 

COPT, 

REAL 

XPOS, 

YPOS, 

+ 

XCHG(8, 

5,j), 

+ 

HDGCHG (8, 5, 5) , 

+ 

OCCPOS, 

CMYPOS 

+ 

PENNOW(15,15,8 

Y,  BDG,  VEL, 

YPOS,  HDGPOS,  VELPOS, 

YCHG,  HDGCHG,  VELCBG, 

CMYPOS ,  C,  COPT, 

DIPT,  OPTCNT,  PENNOW, 


HDG,  VEL, 

OPT CNT(15, 15,8,5) 

HDGPOS,  VELPOS, 
YCHG(8,5,5) , 

VELCHG(5), 

DPOSU),  DIFP(4) , 

5),  PENLAS(15, 15,8,5) 
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Appendix  C.  Turn  Results 


The  results  for  three  turns  of  the  cruise  missile 
follow.  The  optimal  control  inputs  are  applied  and  a 
simulation  of  the  tracking  of  missile  is  performed.  The 
range  and  azimuth  of  the  cruise  misBile  is  presented  every 
0.1  minutes. 

The  bank  control  column  is  the  number  of  degrees  of  bank 
the  pilot  should  fly.  A  negative  value  signals  a  left  turn 
while  a  positive  value  is  a  right  turn. 

The  thrust  control  colum  is  a  relative  measure  of  the 
thrust  the  pilot  should  apply.  The  magnitude  of  this  column 
is  the  percentage  of  maximum  acceleration  or  deceleration 
required.  A  positive  number  is  an  acceleration  while  a 
negative  number  is  a  deceleration. 

The  desired  position  for  the  CMMCA  in  these  run3  was 
defined  to  be  15  nautical  miles  behind  the  missile  (15.52  nm 
slant  range)  and  zero  degrees  azimuth. 

For  each  turn,  the  cruise  missile  starts  out  straight 
and  level  neading  due  north  with  400  knots  airspeed  at  sea 
level.  Ac  0.6  minutes  into  the  manuever,  the  missile  oegins 
its  turn.  The  CMMCA  is  positioned  at  flight  level  290 
heading  d  :e  north  with  400  knots  airpseed.  The  intial  slant 
range  to  the  cruise  missile  is  17.52  nautical  miles. 

Cruise  missile  turns  of  approximately  90  degrees,  180 
degrees,  anu  270  degrees  were  simulated.  CMMCA  controls 


were  computed  using  the  dynamic  programming  methodology  using 


time  increments  of  0.3  minutes,  0.5  minutes,  and  0.7  minutes. 
Figures  showing  the  ground  tracks  of  the  CHMCA  and  the  cruise 
missile  are  provided  after  the  results  from  each  computer 

run. 
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90  Degree  Tun  at 
0.3  Minute  Internals 


Q4CAPMU«1SS  OOKPCtS  HISSTIf  POS  PERKEMMCE 


TKJK 

XFCB 

ISO s 

HDC 

TEL 

BANC  THBET 

CMC 

Off 

KAKZ 

AZOCffl 

o.oo 

10.000 

5.000 

0. 

400. 

O.C 

-1.00 

10.000 

20.000 

15.52 

O.GO 

0.10 

10.000 

5.664 

0. 

397. 

0.0 

-1.00 

10.000 

20.667 

15.53 

0.00 

0.20 

10.000 

6.324 

0. 

394. 

0.0 

-1.00 

10.000 

21.333 

15.53 

C.OQ 

0.30 

10.000 

6.978 

0. 

391. 

0.0 

-1.00 

10.000 

22.000 

15.55 

0.00 

0.40 

10.000 

7.628 

0. 

386. 

0.0 

-1.00 

10.000 

22.667 

15.56 

0.00 

0.50 

10.000 

8.272 

0. 

385. 

0.0 

-1.00 

10.000 

23.333 

15.56 

0.00 

0.60 

10.000 

8.911 

0. 

362. 

0.0 

-1.00 

10.000 

24.000 

15.61 

0.00 

0.70 

10.000 

9.546 

0. 

379. 

0.0 

-1.00 

10.061 

24.663 

15.64 

0.23 

0.80 

10.000 

10.175 

0. 

376. 

0.0 

-1.00 

10.232 

25.307 

15.65 

0.86 

0.90 

10.000 

10.800 

0. 

373. 

0.0 

-1.00 

10.508 

25.913 

15.64 

1.92 

1.00 

10.000 

11.419 

0. 

370. 

0.0 

-1.00 

10.880 

26.465 

15.59 

3.35 

1.10 

10.000 

12.034 

0. 

367. 

0.0 

-1.00 

11.340 

26.947 

15.50 

5.13 

1.20 

10.000 

12.643 

0. 

364. 

9.6 

-0.66 

11.873 

Z7.346 

15.35 

7.26 

1.30 

10.018 

13.246 

3. 

362. 

9.6 

•0.66 

12*465 

27.650 

15.15 

6.53 

1.40 

10.069 

13.848 

6. 

360. 

9.6 

-0.66 

13.100 

27.852 

14.88 

5.96 

1.50 

10.152 

14.440 

9. 

358. 

23.8 

-0.16 

13.759 

27.945 

14.54 

5.5B 

1.60 

10.295 

15.019 

18. 

356. 

23.8 

-0.16 

14.425 

27.927 

14.13 

0.16 

1.70 

10.518 

15.570 

26. 

357. 

23.8 

-0.16 

15.069 

27.865 

13.71 

-5.40 

1.80 

10.818 

16.064 

34. 

357. 

26.9 

0.00 

15.752 

27.803 

13.33 

-11.18 

1.90 

11.194 

16.544 

43. 

357. 

26.9 

0.00 

16.416 

27.741 

12.99 

-18.47 

2.00 

11.640 

16.936 

53. 

357. 

26.9 

0.00 

17.0BD 

Z7.6T9 

12.69 

-26.08 

2.10 

12.144 

17.249 

62. 

357. 

16.7 

-0.27 

17.744 

27.616 

12.44 

-34.03 

2.20 

12.684 

17.495 

68. 

356. 

16.7 

-0.27 

18.407 

27.554 

12.24 

-36.37 

2.30 

13.245 

17.687 

74. 

355. 

16.7 

-0.27 

19.071 

27.492 

12.09 

-42.91 

2.40 

13.820 

17.823 

79. 

354. 

4.5 

-0.49 

19.735 

27.430 

11.97 

-47.64 

2.50 

14.400 

17.924 

81. 

353. 

4.5 

-0.49 

20.399 

27.368 

11.88 

-48.32 

2.60 

14.980 

18.011 

82. 

351. 

4.5 

-0.49 

21.062 

27.306 

11.81 

-49.03 

2.70 

15.560 

18.081 

84. 

350. 

-6.6 

-0.49 

21.726 

27.243 

11.75 

-49.78 

2.80 

16.137 

18.157 

82. 

348. 

-6.6 

-0.49 

22.390 

27.181 

11.68 

-46.80 

2.90 

16.706 

18.255 

79. 

347. 

-6.6 

-0.49 

23.054 

27.119 

11.61 

-43.70 

3.00 

17.273 

18.374 

77. 

345. 

-15.8 

-0.16 

23.717 

27.057 

11.53 

-40.49 

3.10 

17.826 

18.532 

72. 

345. 

-15.8 

-0.16 

24.381 

26.995 

11.43 

-33.88 

3.20 

18.361 

18.741 

66. 

344. 

-15.8 

-0.16 

25.045 

26.933 

11.30 

-26.98 

3.30 

18.872 

18.999 

61. 

344. 

-10.5 

-0.26 

25.709 

26.870 

11.17 

-19.77 

3.40 

19.362 

19.296 

57. 

343. 

-10.5 

-0.26 

26.372 

26.808 

11.03 

-14.14 

3.50 

19.831 

19.622 

54. 

342. 

-10.5 

-0.26 

27.036 

26.746 

10.89 

-8.25 

3.60 

20.278 

19.976 

50. 

342. 

-3.3 

-0.29 

27.700 

26.684 

10.77 

-2.08 

3.70 

20.709 

20.347 

49. 

341. 

-3.3 

-0.29 

28.364 

26.622 

10.68 

1.81 

3.80 

21.132 

20.724 

48. 

340. 

-3.3 

-0.29 

29.027 

26.559 

10.60 

5.82 

3.90 

21.547 

21.1*0 

47. 

339. 

2.6 

-0.22 

29.691 

26.497 

10.55 

9.93 

4.00 

21.960 

21.494 

47. 

336. 

2.6 

-0.22 

30.355 

26.435 

10.53 

12.05 

78 


4.10  22.378  21.871  48.  338.  2.6  -0.22  31.019  26.373  10.53  14.13 

4,20  22.801  22^41  49,  337.  26.2  -0.01  31.683  26,311  10.56  16.14 

4.30  23.259  22.567  59.  337.  26.2  -0.01  32.346  25.249  10.59  9.01 

4.40  23.764  22.810  69.  337.  26.2  -0.01  33.010  26.186  10.62  1.32 

4.50  24.303  22.965  78.  337  .  33.674  26.124  10.67  -6.94 
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90  Degree  Turn 

0.3  Min  Increment 


Y  Position 
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Figure  1.  90  Degree  Turn  at  0,3  Minute  Increments 
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Figure  2.  180  Degree  Turn  at  0.3  Minute  Increments 
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6.17 

-48.99 

3.20 

7.640 

22.827 

283. 

359. 

-26.5 

-0.10 

4.635 

20.229 

5.64 

-53.49 

3.X 

7.047 

22.906 

273. 

359. 

-26.5 

-0.10 

5.277 

20.051 

5.22 

-61.61 

3.40 

6.450 

22.888 

264. 

359. 

-26.5 

-0.10 

5.939 

19.960 

4,97 

-74.23 

3.X 

5.863 

22.776 

255. 

358. 

-X.0 

O.X 

6.606 

2O.0X 

4.92 

-09.93 

3.X 

5.306 

22.563 

244. 

358. 

-x.o 

O.X 

7.272 

20.024 

5.13 

-102.01 

3.70 

4.796 

22.250 

?3\. 

358. 

-x.o 

O.X 

7.938 

20.047 

5.54 

-106.52 

3.X 

4.357 

21.848 

22'  . 

358. 

-x.c 

O.X 

8.604 

20.071 

6.10 

-110.16 

3.X 

3.996 

21.371 

212. 

358. 

-x.o 

O.X 

9.271 

20.094 

6.74 

-108.56 

4.X 

3.734 

20.836 

201. 

358. 

-x.o 

O.X 

9.937 

20.118 

7.42 

-104.87 
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4.10 

3.573 

20.262 

191. 

358. 

-X.0 

0.00 

\0.603 

20.141 

8.09 

-99.80 

4.20 

3.522 

19.667 

190. 

358. 

-30.0 

OJX 

11.269 

2Q.16S 

3.73 

-93.76 

4J0 

3.583 

19.073 

169. 

358. 

-30.0 

o.x 

11.936 

20.188 

9.X 

-86.96 

4.40 

3.752 

18.501 

159. 

356. 

-30.0 

o.x 

12.602 

20.212 

9.86 

-79.62 

4.50 

4.025 

17.971 

146. 

358. 

-30.0 

o.x 

13.268 

20.235 

10.32 

-71.75 

4.60 

4.391 

17.500 

137. 

358. 

-30.0 

o.x 

13.534 

20.258 

10.71 

-63.42 

4.70 

4.09 

17.105 

127. 

358. 

-X.0 

o.x 

14.601 

20.282 

11.02 

-54.62 

4.80 

5.352 

16.800 

116. 

358. 

-X.0 

o.x 

15.267 

20.305 

11.25 

-45.37 

4.90 

5.912 

16.596 

10S. 

358. 

-X.0 

o.x 

15.933 

20.329 

11.42 

-35.63 

5.00 

6.501 

16.499 

95. 

358. 

-23.3 

-0.18 

16.599 

20.332 

11.52 

-25.X 

5.10 

7.096 

16.496 

87. 

358. 

-23.3 

-0.18 

17.266 

2Q.376 

11.59 

-17.41 

5.20 

7.68B 

16.580 

79. 

35"’ 

-23.3 

-0.18 

17.932 

20.399 

11.64 

-9.X 

5.30 

8.260 

16.742 

71. 

357. 

-23.3 

-0.18 

18.596 

X.423 

11.68 

-0.16 

5.40 

8.803 

16.962 

63. 

356. 

-23.3 

-0.18 

19.264 

20.446 

11.72 

9.12 

5.50 

9.307 

17.295 

55. 

356. 

13.3 

0.04 

19.931 

20.470 

11.79 

18.83 

5.60 

9.804 

17.618 

59. 

356. 

13.3 

0.04 

20.597 

20.493 

11.86 

16.14 

5.70 

10325 

17.902 

63. 

356. 

13.3 

0.04 

21,263 

20.516 

11.94 

13.22 

5.80 

10.866 

18.146 

68. 

356. 

13.3 

0.04 

21.929 

20.540 

12.01 

10.05 

5.90 

11.424 

18.347 

72. 

356. 

13.3 

0.04 

22.596 

20.563 

U.07 

6.64 

6.00 

11.996 

18.505 

77. 

356. 

9.0 

-0.53 

23.262 

20.587 

12.13 

3.X 

6.10 

12.576 

18.627 

79. 

355. 

9.0 

-0.53 

23.928 

20.610 

12.X 

0.61 

6.20 

13.159 

18.718 

82. 

353. 

9.0 

-0.53 

24.594 

20.634 

12.27 

-1.96 

6.30 

13.744 

18.779 

85. 

352. 

9.0 

-0.53 

25.261 

20.657 

12.34 

-4.69 

6.40 

14.328 

18.809 

88. 

350. 

9.0 

-0.53 

25.927 

20-681 

12.41 

-7.58 

6.50 

14.910 

18.808 

91. 

348. 

-0.9 

-0.51 

26.593 

20.704 

12.49 

-10.63 

6.60 

15.489 

18.796 

91. 

347. 

-0.9 

-0.51 

27.259 

20.728 

12.56 

-10.42 

6.70 

16.066 

18.786 

91. 

345. 

-0.9 

-0.51 

27.926 

20.751 

12.67 

-10.19 

6.80 

16.641 

18.780 

90. 

344. 

-0.9 

-0.51 

28.592 

20.774 

12.76 

-9.94 

6.90 

17.213 

18.777 

90. 

342. 

-0.9 

-0.51 

29.258 

20.796 

12.85 

-9.67 

7.00 

17.782 

18.777 

90. 

341. 

0.1 

-0.31 

29.924 

20.821 

12.95 

-9.X 

7.10 

18.349 

18.779 

90. 

340. 

0.1 

-0.31 

X.391 

20.845 

13.04 

-9.45 

7.20 

18.915 

18.780 

90. 

339. 

0.1 

-0.31 

31.257 

20.868 

13.14 

-9.51 

7.30 

19.479 

18.781 

90. 

338. 

0.1 

-0.31 

31.923 

20.892 

13.24 

-9.57 

7.40 

20.042 

18.781 

90. 

337. 

0.1 

-0.31 

32.589 

20.915 

13.34 

-9.64 

7.X 

20.603 

18.781 

90. 

336. 

33.256 

20.939 

13.44 

-9.70 
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90  Dwgnw  Turn  tc 
0.7  Klndte  Ioterwla 


CHMCA  HW4HBSRS  CCWRXS  WSSHZ  JOB  HWMgg 


«W 

XPC6 

YFCS  • 

BE 

97L 

AU*.  -SRT? 

CM 

Qtt 

S4KZ 

AZWJIH 

0.00 

10.0® 

5.0® 

0. 

4®. 

0.0 

-1.® 

10.0® 

20.0® 

15.52 

0.® 

0.10 

10.0® 

5.664 

0. 

397. 

0.0 

-1.® 

10.0® 

20.667 

15.53 

0.® 

0.20 

10.0® 

6.324 

0. 

394. 

0.0 

-1.® 

10.0® 

21.333 

15.53 

0.® 

O.X 

10.0® 

6.978 

0. 

391. 

0.0 

-1.® 

10.0® 

22.0® 

15.55 

0.® 

0.40 

10.0® 

7.628 

0. 

388. 

0.0 

-1.® 

10.0® 

22.667 

15.56 

0.® 

0.5) 

10.0® 

8.272 

0. 

385. 

0.0 

-1.® 

10.0® 

23.333 

15.58 

0.® 

0.60 

10.0® 

8.911 

0. 

382. 

0.0 

-1.® 

10.0® 

24.0® 

15.61 

0.® 

0.70 

10.0® 

9.546 

0. 

379. 

0.0 

-0.86 

10.061 

24.663 

15.64 

0.23 

0.® 

io.r® 

10.176 

0. 

376. 

0.0 

-0.86 

10.232 

25.307 

15.65 

C.® 

0.® 

10.0® 

10.W1 

0. 

374. 

0.0 

-0.06 

10.5® 

25.913 

15.64 

1.92 

1.00 

io.goj 

11.422 

0. 

371. 

0.0 

-0.86 

10.880 

26.465 

15.59 

3.35 

1.10 

10.0® 

12.039 

0. 

369. 

0.0 

-0.86 

11.3® 

26. %7 

15.49 

5.13 

1.20 

10.0® 

12.651 

0. 

366. 

0.0 

-0.86 

11.873 

27.346 

15.34 

7.26 

1.® 

10.0® 

13.259 

0. 

363. 

0.0 

-0.86 

12.465 

27.650 

15.14 

9.72 

1.40 

10.0® 

13.863 

0. 

361. 

0.0 

-0.75 

13.1® 

27.852 

14.® 

12.49 

1.50 

10.0® 

14.463 

0. 

359. 

0.0 

-0.75 

13.759 

27.945 

14.56 

15.® 

1.® 

10.0® 

15  059 

0. 

356. 

0.0 

-0.75 

14.425 

27.927 

14.18 

18.96 

1.70 

10.0® 

15.651 

0. 

354. 

0.0 

-0.75 

15.089 

27.865 

13.82 

22.62 

1.® 

10.0® 

16.2® 

0. 

352. 

0.0 

-0.75 

15.752 

27.803 

13.52 

26.45 

1.® 

10.0® 

16.824 

0. 

3®. 

0.0 

-0.75 

16.416 

27.741 

13.28 

30.44 

2.® 

10.0® 

17.405 

0. 

347. 

0.0 

-0.75 

17.00 

27.679 

13.10 

34.57 

2.10 

10.0® 

17.982 

0. 

345. 

12.9 

0.® 

17.744 

27.616 

12.95 

38.79 

2.® 

10.024 

18.557 

4. 

345. 

12.9 

0.® 

18.407 

27.554 

12.33 

38.57 

2.® 

10.093 

19.128 

9. 

345. 

12.9 

0.® 

I9.07i 

27.492 

12.91 

38.21 

2.® 

10.205 

19.692 

13. 

245. 

12.9 

0.® 

19.735 

27.430 

12.91 

37.70 

2.® 

10.3® 

20.245 

18. 

***•5. 

12.9 

0.® 

20.399 

27.368 

12.% 

37.02 

2.® 

10.557 

20.785 

22. 

345. 

12.9 

0.® 

21.062 

27.306 

13.® 

36.14 

2.® 

10.795 

21.309 

26. 

345. 

12.9 

0.® 

21.726 

27.243 

13.07 

35.® 

2.® 

11.073 

21.812 

31. 

345. 

13.1 

0.56 

22.390 

27.181 

13.15 

33.77 

2.® 

11.3® 

22.2% 

35. 

347. 

13.1 

0.56 

23.054 

27.119 

13.24 

32.19 

3.® 

11.744 

22.751 

®. 

348. 

13.1 

0.56 

23.717 

27.057 

13.34 

30.42 

3.10 

12.135 

23.182 

44. 

35C. 

13.1 

0.56 

24.381 

26.995 

13.44 

28.46 

3.20 

12.561 

23.583 

49. 

352. 

13.1 

0.56 

25.045 

26.933 

13.53 

26.32 

3.® 

13.018 

23.952 

53. 

353. 

13.1 

0.56 

25.709 

26.870 

13.62 

23.® 

3.® 

13.504 

24.287 

57. 

355. 

13.1 

0.56 

26.372 

26.8® 

13.71 

21.47 

3.® 

14.017 

24.584 

62. 

3V. 

18.8 

-0.29 

27.036 

26.7 46 

13.79 

18.77 

3.® 

14.556 

24.833 

66. 

356. 

18.8 

-0.29 

27.7® 

26.684 

13.® 

13.84 

3.70 

15.119 

25.019 

75. 

355. 

18.8 

-0.29 

28.364 

26.622 

13.93 

8.60 

3.® 

15.697 

25.142 

81. 

354. 

18.8 

-0.29 

29.027 

26.559 

13.99 

3.05 

3.® 

16.283 

25.2® 

87. 

353. 

18.3 

-0.29 

29.691 

26.497 

14.05 

-2.79 

4,® 

16.871 

25.192 

%. 

353. 

18.8 

-0.29 

».3S5 

26.435 

14.12 

-e.% 

96 


4.10  17.453  25,118  100.  352.  18.8  -0.29  31.019  26.373  14. 

4.20  18,022  24.980  107.  351.  31.683  26.311  14. 
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88 


90  Degree  Turn 

0.7  Min  Increment 


Y  Position 


0  5  X)  16  20  26  30  36 


X  Petition 

?igure  7.  90  Degree  Turn  at  0.7  Minute  Increments 
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180  Dagne  Turn  at 
0.7  Hate  Interval* 


OKA  MUHSSS 

0GNSKX8 

KE59II8  PCS 

PWWfWNCE 

uc y 

xros 

YPCS 

HDG 

V3L 

aur  masT 

CMC 

Off 

SAKE 

AZMffl 

0.00 

10.000 

5.000 

0. 

400. 

0.0 

-1.00 

10.0® 

X.O® 

15.52 

0.® 

0.10 

10.000 

5.664 

0. 

397. 

0.0 

-1.00 

10.0® 

X.667 

15.® 

0.® 

0.20 

10.000 

6.324 

0. 

394. 

0.0 

-1.00 

10.0® 

21.333 

15.® 

0.® 

0.30 

10.000 

6.978 

0. 

391. 

0.0 

-1.00 

10.0® 

22.0® 

15.® 

0.® 

0.40 

10.000 

7.628 

0. 

388. 

0.0 

-1.00 

10.0® 

,2.667 

15.56 

0.® 

0.50 

10.000 

8.272 

0. 

385. 

0.0 

-1.00 

10.0® 

23.333 

15.® 

0.® 

0.60 

10.000 

8.911 

0. 

382. 

0.0 

-1.00 

10.0® 

24.0® 

15.61 

0.® 

0.70 

10.000 

9.546 

c. 

379. 

0.0 

-1.00 

10.061 

24,663 

15.64 

0.23 

0.80 

10.000 

10.175 

0. 

376. 

0.0 

-1.00 

10.232 

25.307 

15.® 

0.88 

0.90 

10.000 

10.800 

0. 

373. 

0.0 

-1.00 

10.508 

25.913 

15.64 

1.92 

1.00 

10.000 

11.419 

0. 

370. 

0.0 

-1.00 

10.8® 

26.465 

15.® 

3.35 

1.10 

10.000 

12.034 

0. 

367. 

0.0 

-1.00 

11.340 

26.947 

15.® 

5.13 

1.20 

10.000 

12.643 

0. 

364. 

0.0 

-1.00 

11.873 

27.346 

15.35 

7.26 

1.30 

10.000 

13.247 

0. 

361. 

0.0 

-1.00 

12.465 

Z7.650 

15.15 

9.71 

1.40 

10.000 

13.847 

0. 

358. 

0.0 

-0.80 

13.1® 

27.882 

14.88 

12.48 

1.50 

10.000 

14.442 

0. 

356. 

0.0 

-0.80 

13.739 

27.945 

14.® 

15.® 

1.60 

10.000 

15.033 

0. 

353. 

0.0 

-0.80 

14.425 

27.9Z7 

14.21 

18.34 

1.70 

10.000 

15.619 

0. 

351. 

0.0 

-0.® 

15.078 

27.796 

13.79 

22.® 

1.80 

10.000 

16.202 

0. 

348. 

0.0 

-0.® 

15.701 

27.563 

13.32 

26.® 

1.90 

10.000 

16.781 

0. 

346. 

0.0 

-0.® 

16.276 

27.226 

12.83 

31.® 

2.00 

10.000 

17.356 

0. 

344. 

0,0 

-0.® 

16.787 

26.799 

12.X 

35.X 

2.10 

10.000 

17.927 

0. 

341. 

9.2 

-0.01 

17.219 

26.293 

11.75 

40.X 

2.20 

10.017 

18.495 

3. 

341. 

9.2 

-0.01 

17.561 

25.722 

11.19 

43.® 

2.X 

10.066 

19.062 

6. 

341. 

9.2 

-0.01 

17.804 

25.1® 

10.® 

45.® 

2.40 

10.146 

19.624 

10. 

341. 

9.2 

-0.01 

17.940 

24.4® 

10.® 

48.73 

2.50 

10.257 

20.182 

13. 

341. 

9.2 

-0.01 

17.965 

23.784 

9.40 

52.27 

2.60 

10.396 

20.732 

16. 

341. 

9.2 

-0.01 

17.909 

23.120 

3.84 

56.51 

2.70 

10.570 

21.274 

19. 

341. 

9.2 

-0.01 

17.849 

22.456 

8.X 

61.75 

2.80 

10.772 

21.805 

22. 

341. 

x.o 

0.® 

17.789 

21.792 

8.® 

67.91 

2.90 

11.042 

22.305 

33. 

341. 

x.o 

0.® 

17.729 

21.128 

7.88 

66.® 

3.00 

11.403 

22.742 

45. 

341. 

x.o 

o.® 

17.669 

X.464 

7.77 

®.29 

3.10 

11.844 

23.100 

56. 

341. 

x.o 

0.® 

17.609 

19.8® 

7.75 

63. 85 

3.20 

12.345 

23.365 

67. 

341. 

x.o 

0.® 

37.549 

19.136 

7.81 

61.92 

3.X 

12.809 

23.527 

78. 

341. 

x.o 

0.® 

17.489 

18.472 

7.92 

59.21 

3.40 

13.454 

23.581 

90. 

341. 

x.o 

0.® 

17.429 

17.808 

8.07 

55.77 

3.® 

14.018 

23.523 

101. 

341. 

24.5 

0.17 

17.369 

17.144 

8.24 

51.37 

3.® 

14.565 

23.368 

no. 

341. 

24.5 

0.17 

17.309 

16.4® 

8.42 

48.48 

3.X 

15.082 

23.  IX 

119. 

342. 

24.5 

0.17 

17.249 

15.816 

8.61 

44.04 

3.80 

15.557 

22.816 

128. 

342. 

'.4.5 

0.17 

17.189 

15.153 

8.® 

40.48 

3.X 

15.979 

22.431 

136. 

343. 

24.5 

0.17 

17.129 

14.489 

8.97 

35.42 

4.X 

16.337 

21.986 

145. 

343. 

24.5 

0.17 

17.069 

13.825 

9.12 

29.71 

99 


4.10 

16.623 

21.490 

154. 

344. 

24.5 

0.17 

17.009 

13.161 

9.25 

23.36 

4.20 

16.830 

20.956 

163. 

344. 

11.5 

-0.25 

16.949 

12.497 

9.36 

16.43 

4.30 

16.979 

30.402 

167. 

344. 

U.5 

-0.25 

16.889 

11.833 

9.46 

13.91 

4.40 

17.090 

19.841 

171. 

343. 

11.5 

-0.25 

16.829 

11.169 

9.55 

11.10 

4.30 

17.161 

19.275 

175. 

342. 

11.5 

-0.25 

16.769 

10.505 

9.65 

8.00 

4.60 

17.194 

18.706 

179. 

341. 

11.5 

-0.25 

16.709 

9.841 

9.74 

4.62 

4.70 

17.187 

18.136 

182. 

341. 

11.5 

-0.25 

16.649 

9.177 

9.83 

0.97 

4.80 

17.141 

17.573 

186. 

340. 

11.5 

-0.25 

16.509 

8.513 

9.92 

-2.95 

4.90 

17.056 

17.013 

190. 

339. 

-6.9 

-0.**) 

16.529 

7.849 

10.01 

-7.12 

5.00 

16.967 

16.456 

186. 

338. 

•6.9 

-0.20 
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